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1. INTRODUCTION 


The Attitude Profile Design (APD) Program is designed to be used as a stand-alone addition to 
the Simplex Computation of Optimum Orbital Trajectories (SCOOT) The program uses information from a 
SCOOT output file and the user-defined attitude profile to produce time histories of attitude, angular body 
rates, and accelerations. 

The APD program is written in standard FORTRAN 77 and should be portable to any machine 
that has an appropriate compiler. The input and output are through formatted files. The program reads the 
basic flight data, such as the states of the vehicles, acceleration profiles, and burn information, from the 
SCOOT output file. The user inputs information about the desired attitude profile during coasts in a high- 
level manner. The program then takes these high level commands and executes the maneuvers, outputting 
the desired information. 
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2. COORDINATE SYSTEMS 


There are four coordinate systems that the user may utilize in specifying his attitude pointing 
commands They are : 

1 . Earth -centered inertial coordinate system, 

2. Solar coordinate system, 

3. Local north-east-down coordinate system, and 

4. Stellar coordinate system. 

The earth-centered inertial (ECI) system is the same as the earth-centered inertial of date (ECID) 
system used in SCOOT The +x-axis points along the vernal equinox. The +z-axis points north along the 
earth's spin axis. The y-axis completes the right-handed orthogonal system. 

The solar coordinate system is a pure rotation of the ECI system at a particular time. The ECI 
system is rotated about its +z-axis, and then about it’s new -t-y-axis until the +x-axis lines up with the sun 
vector. The resulting right-handed orthogonal system is the solar coordinate system. 

The local north-east-down system rotates with the vehicle. It's x- and y-axes are in the local 
horizontal plane and point north and east, respectively. The +z-axis points along the negative earth radius 
vector. 


The stellar coordinate system is defined with the use of the two star vectors that the user inputs. 
The +x-axis lies along the vector to star#l The +z-axis lies in the direction of the cross product of the +x-axis 
with the vector to star#2. The y-axis completes the right-handed orthogonal system. 
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3. INPUT FORMAT 


The basic means of entering data for the user is through a formatted input file. An example of such 
a file is shown below: 

NAME OF NAV FILE: 

STAR #1 DECLINATION: 

STAR #1 RIGHT ASCENSION: 

STAR #2 DECLINATION: 

STAR #2 RIGHT ASCENSION: 

ROLL ATTITUDE DURING BURN: 

BURN PRINT INTERVAL (SECONDS): 

COAST PRINT INTERVAL (SECONDS): 


COAST #: 

MANEUVER #: 

NAME: 

COORDINATE SYSTEM (A.B.C.D): 

POINTING ANGLES: 

SLEW RATE, ACCELERATION: 
ROLL RATE, ACCELERATION: 

BODY RATE COMMANDS: 

BODY ACCELERATION LIMITS: 

TIME OF MANEUVER (MINUTES): 


The first section above appears at the top of every file. The user enters the alpha-numeric name 
of the data file from SCOOT to be used. The next four entries pertain to star locations and should be entered 
in degrees immediately following the colon. Entering preceding blanks may cause unpredictable results and 
is discouraged throughout the input file. The next input is the roll attitude during burns. The angle entered 
is defined with respect to the projection of the sun vector onto the body yz plane. Zero is defined when the 
+y-axis is aligned with the projection. Positive rotation is clockwise. The next input is the desired printout 
interval in seconds for the burn and coast intervals. 
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The next section is the standard maneuver definition section. Each maneuver requires a section 
like this. The first entry is the coast number, and the second entry is the maneuver number. The program 
checks the user to make sure that he has numbered the coasts and maneuvers properly. The important 
thing here is to remember to enter them. The next entry is the name of the maneuver. This is purely for the 
user's benefit in keeping things straight. The next entry is the coordinate system. The user should enter the 
letter (A,B,C,or D) of the system in which he wishes to define the maneuver. The user should always enter 
something here. 

If the maneuver is to be a pointing command (as opposed to a rate command) then the user 
should fill in the next subsection. A pointing command is defined with the use of three angles. The angles 
are defined in the following manner for all coordinate systems except the stellar system. 


ANGLE #1 - the angle of rotation about the +z-axis 
ANGLE #2 - the angle of rotation about the new +y-axis 

ANGLE #3 - the roll angle with respect to the projection of the sun vector onto the body yz plane as 

measured to the body +y-axis (exactly as defined above for the roll attitude during burns) 

For the stellar system, the pointing vector is always along the stellar +z-axis; therefore, the 
following definitions exist for a pointing command. 


ANGLE #1 - the roll angle from the vector to star#l to the body +y-axis. Positive rotation is toward star#2. 
ANGLE #2 - the roll angle from the vector to star#2 to the body +y-axis. Positive rotation is away from star#l . 
Only one of the first two angles may be entered at a time and the third angle is not used. 

The user should enter three angles in degrees, separated by commas, unless the desired attitude 
is the beginning attitude of the upcoming burn. In this case, the user should enter a “B” in the space for the 
pointing angles. The program will then use the burn attitude as the target attitude. 

If the command is a pointing command, then the user has the option of entering rates and 
accelerations that must be observed in achieving the desired attitude. The user should enter these in the 
appropriate spaces. If a rate or acceleration is left blank, then the program assumes that they are infinite 

If the user wants a rate-commanded maneuver, then the next section should be completed. The 
body-rate commands are to be entered in roll, pitch, and yaw order and separated by commas. An “X" may 
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be used instead of a number to indicate that no new command is to be entered for a particular axis. For 
example, a desired pitch rate of 2 deg/s would be achieved by the following entry: 

BODY RATE COMMANDS: X, 2.0 

The roll and yaw body rates would remain unchanged, but the pitch rate would go to 2 deg/s 


The user may also supply accelerations to be observed in achieving the desired rates. They are 
entered in the same manner as the rates. 

The final entry in each maneuver definition is the time of maneuver, and it may contain three 
different types of entries: 

1 A blank indicates that once the desired end condition of this maneuver has been achieved, 
then the vehicle should move on to the next maneuver, 

2. A number indicates that once the desired end condition has been achieved, the vehicle 
should hold this condition for the indicated length of time, 

3. A V’ indicates that the end condition is to be held for an undetermined length of time. The 
following maneuvers are included in this variable time calculation. The next maneuver 
reached that has a time entered here constrains the problem. For example: 

MAN #1 TIME OF MANEUVER: + 

MAN #2 TIME OF MANEUVER: 

MAN #3 TIME OF MANEUVER: 10.0 

This example says that from the beginning of maneuver #1 to the end of maneuver #3 should take 
10 minutes. Since maneuver #1 has a V entered, the extra time is added in holding its end condition until 
maneuver #2 begins. 

The other means of input to the APD program is through an input file from SCOOT. It contains 
several items: 

1 Julian day of the start of the mission, 

2. Number of legs in the mission, 

3. Time history of vehicle position, 

4. Time history of gravitational acceleration, 

5. Time history of thrust acceleration, 

6. Time history of burn/coast condition, 

7. Time history of thrust vector direction. 
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4. OUTPUT FORMAT 


There are six output files. They are : 

1 . INACC.DAT - mission time (s), inertial accelerations x,y,z (m/s/s), 

2. GRACC.DAT - mission time (s), gravitational accelerations x,y,z (m/s/s), 

3. CONACC.DAT - mission time (s), contact accelerations x,y,z (m/s/s), 

4. WBODY.DAT - mission time (s), body angular rates p,q,r (rad/s), 

5. QUAT.DAT - mission time (s), body attitude quaternions qo.qi .qj.cia 

6. APD.LOG - a time history of events. 

The first line of the first five output files above contains an integer indicating the number of data 
lines to follow. 
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5. EXPLANATION OF PROGRAM 


5.1 GENERAL METHODOLOGY 

During a burn interval, the user only has one degree of freedom through the use of the input file. 
The rest are defined through the navigation input file. The one input that the user can enter is roll attitude 
with respect to the sun during burns. Otherwise, the attitude of the vehicle at each timepoint of interest 
(namely, the output timepoints) is taken to be pointing along the thrust vector at all times. The body rates 
are calculated by taking numerical derivatives of the Euler angles at the desired timepoints to get Euler 
rates. These are then converted to body rates. 

During a coast, the user may define either a pointing command or a body rate command-with one 
exception. The first maneuver of the first coast always defines the initial attitude of the vehicle and an error 
will occur if the user tries to do otherwise. 

If the user enters a pointing command, the vehicle already has a given attitude and, possibly, 
body rotational rates. The first thing that is done is that any body rotational rates that are left over from the 
previous maneuver are nulled out. Any existing roll rate and slew rate are nulled simultaneously and 
independently according to the user-defined accelerations for rolling and slewing. 

The next thing to be done is to roll the vehicle to the proper orientation with respect to the sun. 
This is done while obeying the user-defined roll rate and acceleration. 

Next, the vehicle slews in a plane to the desired pointing vector, obeying the user-defined slew 
rate and acceleration. Simultaneously, the roll attitude is being changed so that at the time the slew 
maneuver is completed, the correct roll attitude is being reached also. If the total amount of roll required 
exceeds the physical limitations imposed by the user-defined roll rate and acceleration and the time limit 
imposed by the slew maneuver, then the vehicle rolls at its maximum, and the roll is completed as soon after 
the slew as possible. Otherwise, the roll rate is kept at the minimum rate required to achieve the above- 
stated condition. 

Once the vehicle has achieved the desired attitude conditions, there may be a station-keeping 
requirement imposed by the user. If the user has used the north-east-down system to define the pointing 
command, then a station-keeping command requires that the inertial attitude continue to change to maintain 
the desired conditions. The new attitude is calculated for each timepoint and numerical differentiation is 
used to obtain body rates. If any of the other coordinate systems were used, then no movement is required 
because they are assumed inertial for the station-keeping length. 

If the user has entered a rate command rather than a pointing command, then each axis is treated 
simultaneously and independently. The body rates are changed from the current rates to the desired rates 
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while obeying the accelerations entered by the user. If a hold maneuver condition is called for, the desired 
body rates continue for that length of time and are integrated to determine position at necessary points. 

When the vehicle is commanded to a particular attitude (either roll or pointing) the user-defined 
rates and accelerations are used and obeyed. If the user does not enter a rate, the vehicle assumes the 
desired attitude instantaneously. If a rate is entered without an acceleration, it is achieved instantaneously, 
maintained until the desired attitude is reached, and then nulled out instantaneously. If the user enters a 
rate and an acceleration, then the vehicle accelerates at the user-defined value until the rate is achieved. 
The rate is then maintained for the appropriate time and the vehicle decelerates until a rate of zero and the 
desired attitude are achieved at the same time. Sometimes the attitude change required is so small that the 
above scheme overshoots the desired attitude no matter how short the time at maximum rate. In this case, 
the vehicle accelerates to some sub-maximum rate and immediately begins decelerating to a rate of zero 
and the desired attitude at the same time. 

5.2 SUBROUTINE EXPLANATIONS 


Listed below are brief descriptions of each subroutine: 

ANG - converts any angle in radians to an angle between 0 and 2k 

CONVERT - converts a character string to a real number 

GETPROJ - determines the angle necessary to rotate the vehicle in order to align the body 
y-axis along the projection of the sun vector onto the body yz plane 

GETSTATE - determines (through interpolation) the state of the vehicle at a given time 
using the data read from the navigation input file 

LVLH - determines the coordinate transformation matrix and Euler angles for a given 
attitude in north-east -down coordinates 

QUAT - determines the four quaternions from a coordinate transformation matrix 

QUATUP - integrates body rates to obtain new quaternion values and the coordinate 
transformation matrix 


POINTER - determines the coordinate transformation matrix for an attitude defined in any 
system 


RMAN - reads a single maneuver from the user input file 

ROLLER - computes and executes a roll maneuver from an initial roll attitude to the desired 

roll attitude 


ROTATE - executes rotations about a body axis and computes the new coordinate 
transformation matrix 
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SLEWER 

SUNV 

OUTPUT 


executes a slew maneuver with accompanying roll to a predetermined schedule 
determines the right ascension and declination of the sun at the desired time 
outputs the desired information to the appropriate files 
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6. SAMPLE INPUT FILE 


The following is a maneuver-by-maneuver explanation of a sample input file that covers the 
capability of the Attitude Profile Design (APD) Program. 


COAST #1 

MAN#1 - the initial maneuver always defines the initial conditions of the vehicle. The 
coordinate system is ECI, as indicated by the letter “A". The initial conditions are 
a right ascension of 10.0° and a declination of 20.0°. The body y-axis makes an 
angle of 30.0° with the projection of the sun vector onto the body yz plane. This 
condition is held for 10.0 minutes before moving to the next maneuver. 

MAN#2 - the vehicle slews to the indicated pointing conditions in the solar coordinate 
system using slew and roll rates of 5.0 deg/s and 2.0 deg/s, respectively. Slew and 
roll accelerations are both 2.0 deg/s/s. This attitude is not held before moving to 
the next maneuver. 

MAN#3 - the vehicle achieves a clockwise roll of 3.0 deg/s using an acceleration of 
2.0 deg/s. Once the desired rate is achieved, it is held for 25.0 minutes. 

MAN#4 - the vehicle achieves a counterclockwise roll of 3.0 deg/s and is held for 25.0 
minutes. 

MAN#5 - the vehicle slews to the indicated attitude in north-east-down coordinates at the 
indicated rates and accelerations. The *+” in the time entry, along with the 10.0 
minutes in the next maneuver time entry, indicates that the time elapsed from the 
beginning of maneuver#5 to the end of maneuver#6 is to be 10.0 minutes. 

MAN#6 - the vehicles slews to the desired solar orientation 

MAN#7 thru MAN#10 - repeats MAN#3 thru MAN#6 

MAN#1 1 thru MAN#14 - repeats MAN#3 thru MAN#6 

MAN#15 thru MAN#18 - repeats MAN#3 thru MAN#6 

MAN#19 thru MAN#22 - repeats MAN#3 thru MAN#6 

MAN#23 - vehicle slews to stellar pointing vector. The body y-axis makes an angle of 10 0° 
with the vector to star#l 

MAN#24 - vehicle rolls so that body y-axis makes an angle of -10.0° with the vector to star#i 

MAN#25 - vehicle rolls so that body y-axis makes an angle of 10.0° with the vector to star#2 

MAN#26 - vehicle rolls so that body y-axis makes an angle of -1 0.0° with the vector to star#2 
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MAN#27 


- vehicle slews to the attitude for burn #1. as indicated by the “B" in the pointing 
angle entry. 


COAST#2 

MAN#1 - vehicle slews to the attitude for burn#2 

COAST#3 

MAN#1 - vehicle slews to the attitude for burn#3 

The sample data input file associated with the previous explanation is presented on the following 

pages. 
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NAME OF NAV FILE : BRET NAV.DAT 
STAR #1 DECLINATION :l5.2 
STAR #1 RIGHT ASCENSION :20.3 
STAR #2 DECLINATION :16.3 
STAR #2 RIGHT ASCENSION : 22 . 4 
ROLL ATTITUDE DURING BURN :0.0 
BURN PRINT INTERVAL ( SECONDS ) : 1. 

COAST PRINT INTERVAL (SECONDS) : 20. 


COAST # : L 

MANEUVER # : 1 

NAME : INERTIAL POINTING 

COORDINATE SYSTEM <A,B,C,D> :A 

POINTING ANGLES : 1 0 . 0 , 2 0 . 0 , 3 0 . 0 
SLEW RATE, ACCEL : 

ROLL RATE, ACCEL : 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) :10.0 


COAST ♦ : I 
MANEUVER # : 2 

NAME : SLEW TO SOLAR ORIENTATION 
COORDINATE SYSTEM (A, B, C, D) :B 

POINTING ANGLES :0. 0,40. 0,0.0 
SLEW RATE , ACCEL : 5 . 0 , 2 . 0 
ROLL RATE, ACCEL : 3. 0,2.0 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) : 


COAST # : I 

MANEUVER # : 3 

NAME : ROLL CLOCKWISE 

COORDINATE SYSTEM (A,B,C,D) :B 

POINTING ANGLES : 

SLEW RATE, ACCEL : 

ROLL RATE, ACCEL : 

BODY RATE COMMANDS :3.0 
BODY ACCEL LIMITS : 2 . 0 

TIME OF MANEUVER (MINUTES) :25.0 


COAST # : 1 

MANEUVER # : 4 

NAME : COUNTERCLOCKWISE ROLL 
COORDINATE SYSTEM <A,B,C,D) :B 

POINTING ANGLES : 

SLEW RATE, ACCEL : 

ROLL RATE, ACCEL : 

BODY RATE COMMANDS :-3.0 
BODY ACCEL LIMITS :2.0 

TIME OF MANEUVER (MINUTES) :25.0 


COAST # : 1 
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MANEUVER f : 5 

NAME : SLEW TO NEGATIVE EARTH RADIUS VECTOR 
COORDINATE SYSTEM (A, B,C,D) :C 

POINTING ANGLES :0. 0,90. 0,0.0 
SLEW PATE, ACCEL : 5. 0,2.0 
ROLL PATE, ACCEL : 3. 0,2.0 

BODY PATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) :+ 


COAST # : 1 
MANEUVER # : 6 

NAME : SLEW TO SOLAR ORIENTATION 
COORDINATE SYSTEM (A,B,C,D) :B 

POINTING ANGLES : 0 . 0 , 40 . 0 , 0 . 0 
SLEW RATE, ACCEL : 5. 0,2.0 
ROLL RATE, ACCEL : 3. 0,2.0 

BODY PATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) :10.0 


COAST # : 1 

MANEUVER # :7 

NAME : ROLL CLOCKWISE 

COORDINATE SYSTEM (A,B,C,D) :B 

POINTING ANGLES : 

SLEW PATE, ACCEL : 

ROLL RATE, ACCEL : 

BODY RATE COMMANDS :3.0 
BODY ACCEL LIMITS :2.0 

TIME OF MANEUVER (MINUTES) : 25 . 0 


COAST # : 1 
MANEUVER # : 8 

NAME : COUNTERCLOCKWISE ROLL 
COORDINATE SYSTEM (A,B,C,D) :B 

POINTING ANGLES : 

SLEW RATE, ACCEL : 

ROLL RATE, ACCEL : 

BODY RATE COMMANDS : -3 . 0 
BODY ACCEL LIMITS :2.0 

TIME OF MANEUVER (MINUTES) :25.0 


COAST # : 1 
MANEUVER # : 9 

NAME : SLEW TO NEGATIVE EARTH RADIUS VECTOR 
COORDINATE SYSTEM (A,B,C,D) :C 

POINTING ANGLES : 0 . 0 , 90 . 0 , 0 . 0 
SLEW RATE, ACCEL : 5. 0,2.0 
ROLL RATE, ACCEL : 3. 0,2.0 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 
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TIME OF MANEUVER (MINUTES) : + 


COAST # : 1 

MANEUVER * : 10 

NAME : SLEW TO SOLAR ORIENTATION 
COORDINATE SYSTEM (A,3,C,D> :B 

POINTING ANGLES : 0 . 0 , 4 0 . 0 , 0 . 0 
SLEW PATE , ACCEL : 5. 0,2.0 
ROLL PATE, ACCEL : 3. 0,2.0 

BODY PATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) : 10 . 0 


COAST # : 1 

MANEUVER * : 11 

NAME : ROLL CLOCKWISE 

COORDINATE SYSTEM (A,B,C,D) :B 

POINTING ANGLES : 

SLEW RATE, ACCEL : 

ROLL RATE, ACCEL : 

BODY RATE COMMANDS :3.0 
BODY ACCEL LIMITS :2.0 

TIME OF MANEUVER (MINUTES) :25.0 


COAST # : 1 

MANEUVER # : 12 

NAME : COUNTERCLOCKWISE ROLL 

COORDINATE SYSTEM (A,B,C,D) :B 

POINTING ANGLES : 

SLEW RATE, ACCEL : 

ROLL RATE, ACCEL : 

BODY RATE COMMANDS : -3 . 0 
BODY ACCEL LIMITS :2.0 

TIME Of MANEUVER (MINUTES) :25.0 


COAST # : 1 
MANEUVER # : 13 

NAME : SLEW TO NEGATIVE EARTH RADIUS VECTOR 
COORDINATE SYSTEM (A, B,C,D) :C 

POINTING ANGLES :0. 0,90. 0,0.0 
SLEW RATE, ACCEL : 5. 0,2.0 
ROLL RATE, ACCEL : 3. 0,2.0 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OP MANEUVER (MINUTES) :+ 


COAST # : 1 
MANEUVER # :14 

NAME : SLEW TO SOLAR ORIENTATION 
COORDINATE SYSTEM (A,B,C,D) :B 

POINTING ANGLES : 0 . 0 , 40 . 0 , 0 . 0 
SLEW RATE, ACCEL : 5. 0,2.0 
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ROLL RATE , ACCEL : 3 . 0 , 2 . 0 

BODY PATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) ;10.0 


COAST # : 1 

MANEUVER # :15 

NAME : ROLL CLOCKWISE 

COORDINATE SYSTEM (A, B,C,D) :B 

POINTING ANGLES : 

SLEW PATE, ACCEL : 

ROLL RATE, ACCEL : 

BODY RATE COMMANDS :3.0 
BODY ACCEL LIMITS :2.0 

TIME OF MANEUVER (MINUTES) :25.0 


COAST * : 1 

MANEUVER # : 1 6 

NAME : COUNTERCLOCKWISE ROLL 

COORDINATE SYSTEM <A,B,C,D) :B 

POINTING ANGLES : 

SLEW RATE, ACCEL : 

ROLL RATE, ACCEL : 

BODY PATE COMMANDS :-3.0 
BODY ACCEL LIMITS :2.0 

TIME OF MANEUVER (MINUTES) :25.0 


COAST # : 1 
MANEUVER # :17 

NAME : SLEW TO NEGATIVE EARTH RADIUS VECTOR 
COORDINATE SYSTEM (A,B,C,D) :C 

POINTING ANGLES : 0 . 0 , 90 . 0, 0 . 0 
SLEW RATE, ACCEL : 5. 0,2.0 
ROLL RATE, ACCEL : 3. 0,2.0 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) :+ 


COAST # : 1 
MANEUVER # : 1 8 

NAME : SLEW TO SOLAR ORIENTATION 
COORDINATE SYSTEM (A,B,C,D) :B 

POINTING ANGLES :0. 0,40. 0,0.0 
SLEW RATE, ACCEL :5. 0,2.0 
ROLL RATE, ACCEL : 3. 0,2.0 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) :10.0 


COAST # : I 
MANEUVER # :19 
NAME : ROLL CLOCKWISE 
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COORDINATE SYSTEM (A, 8,0,0) :B 


POINTING ANGLES : 

SLEW RATE, ACCEL : 

ROLL RATE, ACCEL : 

BODY PATE COMMANDS : 3 . 0 
BODY ACCEL LIMITS :2.0 


TIME OF MANEUVER 

(MINUTES) : 2 5 . 0 

COAST # : 1 

MANEUVER ♦ :20 


NAME : COUNTERCLOCKWISE ROLL 
COORDINATE SYSTEM <A,B,C,D) :B 

POINTING ANGLES 
SLEW PATE, ACCEL 
ROLL RATE, ACCEL 


BODY RATE COMMANDS : - 3 . 0 
BODY ACCEL LIMITS :2.0 

TIME OF MANEUVER 

(MINUTES) : 25 . 0 

COAST # : 1 
MANEUVER f :21 


NAME : SLEW TO NEGATIVE EARTH RADIUS VECTOR 
COORDINATE SYSTEM (A,B,C,D) :C 

POINTING ANGLES 

0.0,90.0,0.0 

SLEW RATE, ACCEL 

5. 0,2.0 

ROLL RATE, ACCEL 

3. 0,2.0 

BODY PATE COMMANDS : 
BODY ACCEL LIMITS : 

TIME OF MANEUVER 

(MINUTES) :+ 

COAST # : 1 
MANEUVER # :22 


NAME : SLEW TO SOLAR ORIENTATION 
COORDINATE SYSTEM (A,B,C,D) :B 

POINTING ANGLES 

o 

o 

4 * 

O 

o 

o 

o 

SLEW RATE, ACCEL 

5. 0,2.0 

ROLL RATE, ACCEL 

3. 0,2.0 

BODY RATE COMMANDS : 
BODY ACCEL LIMITS : 

TIME OF MANEUVER 

(MINUTES) : 10 . 0 


COAST f : 1 
MANEUVER # :23 

NAME : SLEW TO SOLAR ORIENTATION 
COORDINATE SYSTEM (A,B,C,D) :D 

POINTING ANGLES :10.0,X,0.0 
SLEW RATE, ACCEL : 5. 0,2.0 
ROLL RATE, ACCEL : 3. 0,2.0 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) : 
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COAST * : 1 

MANEUVER # : 2 4 

NAME : ROLL THROUGH STAR 1 

COORDINATE SYSTEM (A f B,C,D) :D 

POINTING ANGLES :-10.0 
SLEW PATE, ACCEL : 

ROLL PATE, ACCEL : 3. 0,2.0 

BODY PATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) 


COAST # : 1 
MANEUVER # : 25 

NAME : ROLL THROUGH STARS 1 AND 2 
COORDINATE SYSTEM <A,B,C,D) :D 

POINTING ANGLES :X, 10.0 
SLEW RATE, ACCEL : 

ROLL RATE, ACCEL : 3. 0,2.0 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) : 


COAST # : 1 

MANEUVER # :26 

NAME : ROLL THROUGH STAR 2 

COORDINATE SYSTEM (A, B,C,D) :D 

POINTING ANGLES :X f -10.0 
SLEW RATE, ACCEL : 

ROLL RATE, ACCEL : 3. 0,2.0 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) : 


COAST * : 1 

MANEUVER # :27 

NAME : SLEW TO BURN ATTITUDE 

COORDINATE SYSTEM (A,B,C,D) :A 

POINTING ANGLES :B 
SLEW RATE, ACCEL :5. 0,2.0 
ROLL RATE, ACCEL : 3. 0,2.0 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) : 

COAST # : 2 
MANEUVER # : 1 

NAME : SLEW TO BURN ATTITUDE 
COORDINATE SYSTEM (A,B,C,D) :A 

POINTING ANGLES :B 
SLEW RATE, ACCEL : 5. 0,2.0 
ROLL RATE, ACCEL : 3. 0,2.0 
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BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) : 


COAST ♦ : 3 
MANEUVER # : 1 

NAME : SLEW TO BURN ATTITUDE 
COORDINATE SYSTEM (A,B,C,D) :A 

POINTING ANGLES :B 
SLEW RATE, ACCEL : 5. 0,2.0 
ROLL RATE, ACCEL : 3. 0,2.0 

BODY RATE COMMANDS : 

BODY ACCEL LIMITS : 

TIME OF MANEUVER (MINUTES) : 
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FUNCTION ANG(X) 

IMPLICIT REAL* 8 <A-H,0-Z) 

COMMON/ COM3 /PI , TWOP I r P 102 
ANG*X - TWOP I * FLOAT ( INT (X/TWOPI) ) 
IF(ANG) 1,2,2 

1 ANG-ANG+TWOPI 

2 RETURN 
END 



PROGRAM ATTITUDE 
IMPLICIT REAL* 8 (A-H,0-Z) 

C 

C THIS PROGRAM REQUIRES INPUT FROM A SAMBO OUTPUT RUN AND INPUT FROM 
C A FORMATTED INPUT FILE THAT DEFINES PARAMETERS FOR THE ATTITUDE 
C PROFILE HISTORY 

C 

COMMON / COM1 /DTIME , DX , DGACC , DMACC, IBRN, 

1 DRA, DDEC 

COMMON/COM2/PINT, TIMEO 
COMMON/ COM3 /P I , TWOPI, PI02 
COMMON/ COM4 /RB URN 
COMMON/ COM6/TRO , TRI , TR2 , WPMAX 

COMMON /COM7 / SANG1 , SANG2 , STARROT1, STARROT2, SV1 , SV2 
CHARACTER* I 5 SFILE 
CHARACTER* 20 FNAME 
CHARACTER* 4 0 NAME, NAMEZ (5) 

DIMENSION STARDEC ( 2 ) , STARRA (2 ) , A ( 3 , 3 ) , B ( 3 , 3 ) , POINT ( 3 ) , IPOINT ( 3 ) , 

1 SLEW (2) , I SLEW (2 ) , ROLL (2) , IROLL(2) f RATE (3) , IRATE (3) , 

2 ACCEL (3) , IACCEL ( 3 ) , TV1 (3) ,TV2<3) ,CI2M(3, 3) ,ROLLM(3, 3) , 

3 C (3, 3) , ISYSZ (5) , STIMEZ (5) , ITIMEZ (5) , 

4 POINTZ <5,3), IPOINTZ (5,3) , RATEZ (5,3), 

5 IRATEZ <5, 3) , ACCELZ (5, 3) , IACCELZ <5, 3) , SLEWZ (5,2) , 

6 I SLEWZ (5,2) , ROLLZ (5,2), IROLLZ (5,2) , DTIME (5000) , 

7 DX (5000, 3 ) , DGACC (5000, 3) , DMACC (5000 , 3) , IBRN (5000) , 

0 DRA (5000) , DDEC (5000) ,RAB(20) ,DECB(20) ,TSTAY(50) , 

9 BRATE (3) , BRATEP (3) , IACC (3) ,TACC(3) , SACC (3) ,X<3) , 

1 DUM1 (3) , DUM2 (3) , TIMEB(20) ,TIMEC(20) ,D<3, 3) , ASV(3, 3) , 

2 SV1 (3) , SV2 (3) , SCANV (3) , SV1M<3) ,SV2M<3) 


DATA 

PI 

/3. 14139265/ 

DATA 

TWOPI 

/6. 28318531/ 

DATA 

PI02 

/l. 57079633/ 

DATA 

TOL 

/0.1/ 

DATA 

TDIFF 

/0.01/ 

DATA 

TINT 

/0.1/ 

DATA 

TTOL 

/0.1/ 


WRITE (6,*) 'WELCOME TO THE ATTITUDE PROFILE HISTORY PROGRAM' 
WRITE (6, *) 'PLEASE ENTER THE NAME OF THE INPUT DATA FILE' 
READ (5,99) FNAME 

99 FORMAT (A20) 

C 

C OPEN INPUT FILE 

C 

OPEN (UNIT-13, FILE-'APD. LOG' , STATUS-' NEW' ) 

OPEN (UNIT-20, FILE-FNAME, STATUS-' OLD' ) 

OPEN (UNIT-31, FILE-' INACC.DAT' , STATUS-' NEW' ) 

OPEN (UNIT-32, FILE-' GRACC.DAT' , STATUS-' NEW' ) 

OPEN (UNIT-33, FILE-' CONACC.DAT' , STATUS-' NEW' ) 

OPEN (UNIT-34, FILE-' WBODY.DAT' , STATUS-' NEW' ) 

OPEN (UNIT-35, FILE-' QUAT.DAT' , STATUS-' NEW' ) 

C 

C READ SAMBO FILE NAME 

C 

READ (20,100) SFILE 

100 FORMAT (18X,A15) 

OPEN (UNIT-21, FILE-SFILE, STATUS-' OLD' ) 

C 

C READ JULIAN DAY 

C 

C READ (20,101) IYY, IMM, IDD, IHH, IMM, S3 

C 101 FORMAT (52X, 5 (12, IX) ,F6.3) 

C 

C CHECK FOR MISTAKES 
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c 

C ir (IMM . LT. 0 .OR. IMM . GT . 12) THEN 

C WRITE (6,*) 'YOU HAVE ENTERED AN INVALID MONTH' 

C STOP 

C ELSE IF ( IDD . LT . 0 .OR. IDD . GT . 31) THEN 

C WRITE (6,*) 'YOU HAVE ENTERED AN INVALID DAY' 

C STOP 

C ELSE IF (IDD . EQ . 31 .AND. (IMM . EQ . 2 .OR. IMM . EQ . 4 .OR. IMM 

C 1 .EQ. 6 .OR. IMM . EQ . 9 .OR. IMM . EQ . 11)) THEN 

C WRITE (6,*) 'THE MONTH YOU HAVE ENTERED DOES NOT HAVE 31 DAYS' 

C STOP 

C ELSE IF (IMM . EQ . 2 .AND. (IDD . EQ . 30 .OR. IDD . EQ . 29 .AND. 

C 1 MOD ( I YY, 4 ) .NE. 0)) THEN 

C WRITE (6,*) 'FEBRUARY DOES NOT HAVE THIS MANY DAYS THIS YEAR' 

C STOP 

C ELSE IF (IHH . LT . 0 .OR. IHH . GT . 23) THEN 

C WRITE (6,*) 'YOU HAVE ENTERED AN INVALID HOUR' 

C STOP 

C ELSE IF (IMM . LT . 0 .OR. IMM . GT . 59) THEN 

C WRITE ( 6 , * ) 'YOU HAVE ENTERED AN INVALID MINUTE' 

C STOP 

C ELSE IF (SS .LT. 0 .OR. S3 . GE . 60.0) THEN 

C WRITE (6,*) 'YOU HAVE ENTERED AN INVALID SECOND' 

C STOP 

C END IF 

C 

C GET STAR COORDINATES 

C 


* PI /180 . 0 


COS (STARRA(l) ) 
3 IN ( S TAARA ( 1 ) ) 

COS (STARJUM2) ) 
SIN (3TARRA (2) ) 


3V2 (1) 
SV2 (2) 


DO I - 1,2 

READ (20,102) STARDEC ( I ) 

STARDEC ( I ) - STARDEC (I) 

102 FORMAT (21X,F20.5) 

READ (20,103) STARRA(I) 

STARRA(I) ■ STARRA ( I ) *P 1/ 1 80 . 0 

103 FORMAT (25X,F20.5) 

END DO 

SV1(1) - COS (STARDEC (1) ) 

SV1 (2 ) - COS (STARDEC (1) ) 

SV1 (3) - SIN (STARDEC (1) ) 

SV2 ( 1 ) - COS (STARDEC (2) ) 

SV2<2) - COS (STARDEC (2) ) 

S V2 ( 3 ) - SIN (STARDEC (2) ) 

SCANV(l) - 3 VI (2) * 3V2 (3) 

SCANV (2) - SV1 ( 3 ) * 

SCANV (3) - SV1 (1) * 

XMAG - ( SCANV ( 1 ) **2 
SCANV (1 ) - SCANV ( 1) 

SCANV (2 ) - SCANV<2) 

SCANV (3) - SCANV (3) 

SANG1 - AT AN 2 (SCANV ( 2 ), SCANV ( 1 ) ) 

SANG2 - ASIN (SCANV ( 3) ) 

DO I - 1,3 
DO J - 1,3 

IF (I .EQ. J) 

A(I,J) - 1 
ELSE 

A ( I , J) - 0.0 

END IF 
END DO 
END DO 

CALL ROTATE (A, SANG1 , -SANG2 ,0.0, 3,2,0) 
DO I - 1,3 

SV1M(I) - A ( I , 1 ) * SVX(l) + A ( I , 2 ) 
SV2M ( I ) - A ( I , 1 ) * SV2 ( 1 ) + A ( I , 2 ) 
END DO 

STARROT1 - ATAN2 (SV1M ( 3) , SV1M (2 ) ) 


- 3V1 (3) 

- SV1(1) 

- 3 VI ( 2 ) 
+ SCANV (2) **2 + 
/ XMAG 

/ XMAG 
/ XMAG 


THEN 

.0 


* SV2 (2) 

* 3V2 (3) 

* 3Va<l) 

SCANV (3) **2) ** 0.3 


3V1 (2) 
3V2 (2) 


+ A ( I, 3) * SV1 ( 3 ) 

+ A< I, 3) * 3V2 ( 3 ) 
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non 


STAKR0T2 - AT AN 2 < SV2M < 3 ) , 3V2M (2 ) ) 

READ (20,194) R BURN 
RBURN - RBURN *P I / 1 80 . 0 

194 FORMAT (28X,F20.10) 

READ (20,195) PINTB 

195 FORMAT ( 3 IX, F2 0 . 1 0 ) 

READ (20,196) PINTC 

196 FORMAT (32X,F20.10) 

C 

C READ SAMBO STUFF 

READ (21,*) TIMEO , NLEGS 
IBRNL - 0 
I LEG - 1 
DO I - 1,5000 

READ (21, *, END-200) DTIME (I) , DX ( I , 1 ) , DX ( I , 2 ) , DX ( I , 3) , 

1 DGACC (1,1) , DGACC (1,2) ,DGACC(I,3) , 

2 DMACC ( I , 1 ) , DMACC (1,2) , DMACC (1,3), 

3 IBRN(I) , DRA ( I ) ,DDEC(I) 

IF (IBRNL .EQ. 0 .AND. IBRN(X) .EQ. 1) THEN 

TIMEB(ILEG) * DTIME (I) 

RAB(ILEG) - DRA ( I ) 

DECB ( I LEG) - DDEC(I) 

ELSE IF (IBRNL . EQ . 1 .AND. IBRN(I) . EQ . 0) THEN 
TIMEC(ILEG) - DTIME (1-1) 

I LEG - I LEG + 1 
END IF 

IBRNL - IBRN(I) 

END DO 

200 TIMEC(ILEG) - DTIME(I-l) 

NPNT - 1 
DO I - 1, I LEG 

IF (I .EQ. 1) THEN 

NPNT - NPNT + INT (TIMES (1) /PINTC) + 

1 INT( (TIMBC(l) -TIMES (1) > /PINTS) + 2 

ELSE 

NPNT • NPNT + INT< (TIMES (I) -TIMEC(I-l) ) /PINTC) + 

1 INT( (TIMEC(I) - TIMES (I) ) /PINTS) + 2 

END IF 
END DO 

WRITE (31 , *) NPNT 
WRITE (32,*) NPNT 
WRITE (33,*) NPNT 
WRITE (34,*) NPNT 
WRITE (35,*) NPNT 
A(l,l) - 1.0 
A (2 , 2 ) - 1.0 
A (3, 3) - 1.0 
Q0 - 1.0 
I READ - 0 

INITIALIZE COAST AND MANEUVER COUNTERS 

ICOAST - 1 

I MAN - 1 

1000 PINT - PINTC 

CALL QUAT (A, QO, Ql, Q2, Q3) 

SRA - PAS (ICOAST) 

SDEC - DECB (ICOAST) 

999 IF (TIME . GE . TIMES ( ICOAST) ) THEN 
IF (PINT .EQ. PINTC) THEN 
PINT - PINTB 
TIME - TIMEB (ICOAST) 

PTIME - TIME 

CALL GETSTATE (TIME, X, DUM1 , DUM2, RA, DEC) 
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PS IM - RA 
THTM - -DEC 
DO I - 1,3 
DO J ■ 1,3 

IF (I . EQ. J) THEN 


A (I, J) 

- 1.0 

B ( I , J) 

- 1.0 

C ( I , J) 

- 1.0 

ELSE 

A (I , J) 

- 0.0 

B(I, J) 

- 0.0 

C(I, J) 

- 0.0 

END IF 
END DO 
END DO 

CALL ROTATE (A, 

RA, -DEC 


CALL GETPROJ {TIME, A, ROT) 

CALL ROTATE (A, 0 . 0 , 0 . 0 , ROT +RBURN, 0,0,1) 

PHIM - ROT+RBURN 

CALL GETSTATE (TIME+ TDIFF, X, DUM1 , DUM2 , RA, DEC) 

CALL ROTATE (B, RA, -DEC, 0 . 0 , 3 , 2 , 0 ) 

CALL GETPROJ ( TIME+TD IFF , B , ROT) 

PSIP - RA 

THTP - -DEC 

PHIP - ROT+RBURN 

PSI » (PSIP+PSIM) * 0.5 

THT - (THTP+THTM) * 0.5 

PHI - (PHIP+PHIM) * 0.5 

PSID - (PSIP-PSIM) / TDIFF 

THTD ■ (THTP -THTM) / TDIFF 

PHID - (PHIP-PHIM) / TDIFF 

WP - PHID - PSID * SIN (THT) 

WQ - THTD * COS (PHI) + PSID * COS (THT) * SIN (PHI) 

WR - PSID * COS (THT) * COS (PHI) - THTD * SIN (PHI) 

CALL OUTPUT (0 , TIME, A, WP, WQ, NR, PTIME) 

GOTO 999 
END IF 

IF (PTIME .GT. TIMEC (ICOAST) ) THEN 
PINT - PINTC 
TIME - TIMEC (ICOAST) 

PTIME - TIME 

CALL GETSTATE ( TIME- TDIFF , X, DUM1 , DUM2 , RA, DEC) 
PSIM - RA 
THTM - -DEC 
DO I - 1 , 3 
DO J - 1, 3 

IF (I .EQ. J) THEN 
A (I , J) - 1.0 
B ( I , J) - 1.0 
ELSE 

A ( I , J) - 0.0 
B ( I , J) - 0.0 
END IF 
END DO 
END DO 

CALL ROTATE (B, RA, -DEC, 0 . 0 , 3, 2 , 0) 

CALL GETPROJ (TIME, B, ROT) 

PHIM - ROT + RBURN 

CALL GETSTATE (TIME, X, DUM1 , DUM2, RA, DEC) 

PSIP - RA 
THTP - -DEC 

CALL ROTATE (A, RA, -DEC, 0 . 0 , 3, 2 , 0 ) 

CALL GETPROJ (TIME, A, ROT) 

CALL ROTATE (A, 0 . 0 , 0 . 0 , ROT+RBURN, 0 , 0 , 1) 

PHIP - ROT+RBURN 

PSI - (PSIP+PSIM) * 0.5 
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THT • (THTP+THTM) * 0.5 
PHI - (PHIP+PHIM) * 0.5 
PSID - (PSIP-PSIM) / TDirr 

THTD - (THTP-THTM) / TDIFF 

PHID - (PHIP-PHIM) / TDIFF 

WP - PHID - PSID * S IN (THT) 

WQ - THTD * COS (PHI) + PSID * COS (THT) * SIN (PHI) 

WR - PSID * COS (THT) * COS (PHI) - THTD * SIN (PHI) 

CALL OUTPUT ( 0 , TIME , A, WP , WQ , WR, PTIME) 

ELSE 

TIME - PTIME-TDIFF*0 . 5 

CALL GETSTATE (TIME, X, DUM1 , DUM2 , RA, DEC) 

PSIM - RA 
THTM - -DEC 
DO I ■ 1,3 
DO J - 1, 3 

IF (I .EQ. J) THEN 
A(I, J) - 1.0 
B(I, J) - 1.0 
C (I, J) - 1.0 
ELSE 

A ( I , J) - 0.0 
B(I,J) - 0.0 
C(I,J) - 0.0 
END IF 
END DO 
END DO 

CALL ROTATE <B, RA, -DEC , 0 . 0 , 3 , 2 , 0 ) 

CALL GETPROJ (TIME, B, ROT) 

PHIM - ROT + RBURN 
TIME - PTIME 

CALL GETSTATE (TIME, X, DUM1 , DUM2 , RA, DEC) 

PSI - RA 
THT - -DEC 

CALL ROTATE (A, RA, -DEC, 0 . 0 , 3, 2 , 0) 

CALL GETPROJ (TIME, A, ROT) 

CALL ROTATE (A, 0.0,0. 0,ROT+RBURN, 0,0,1) 

PHI - ROT + RBURN 

CALL GETSTATE (TIME + . 5*TDIIT, X, DUM1 , DUM2 , RA, DEC) 
PSIP - RA 
THTP - -DEC 

CALL ROTATE (C, RA, -DEC, 0 . 0 , 3, 2 , 0) 

CALL GETPROJ (TIME* . 5*TDIFF, C, ROT) 

PHIP - ROT + RBURN 
PSID - (PSIP-PSIM) / TDIFF 
THTD - (THTP-THTM) / TDIFF 
PHID - (PHIP-PHIM) / TDIFF 
WP - PHID - PSID * SIN (THT) 

WQ - THTD * COS (PHI) + PSID * COS (THT) * SIN (PHI) 
WR - PSID * COS (THT) * COS (PHI) - THTD * SIN (PHI) 
CALL OUTPUT (0 , TIKE, A, WP, WQ, WR, PTIME) 

GOTO 999 
END IF 
END IF 
C 

C READ A MANEUVER 

C 


IF (IREAD .LE. 1) THEN 

CALL RMAN (JCOAST, JMAN, NAME, ISYS, POINT, IPOINT, SLEW, ISLEW, ROLL, 
1 I ROLL, RATE, IRATE, ACCEL, IACCEL, STIME, I TIME) 


C 

C CHECK COAST AND MANEUVERS 

C 

IF (ICOAST .EQ. 1 .AND. IMAN 


. EQ . 1 . AND . 


(JCOAST .NE. 


1 .OR. JMAN 
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1 


THEN 

) 'THE FIRST MANEUVER MUST BE COAST #1 AND MANEUVER # 


.NE. 1)) 

WRITE <6, 

11 ' 

STOP 

ELSE IF { ICOAST . EQ . JCOAST) 
IF ( I MAN .NE. JMAN) THEN 


THEN 


WRITE (6,*) 

1 

STOP 
END IF 
ELSE 

IF (JCOAST .NE. 
WRITE (6,*) 


' YOU HAVE MISNUMBERED YOUR MANEUVERS' , JCOAST, 
JMAN 


ICOAST + 1 .AND. JMAN . EQ . 1) THEN 

' YOU HAVE MISNUMBERED YOUR COASTS OR NOT RESTART 


1ED YOUR MANEUVER NUMBERS ' , JCOAST , JMAN 
STOP 
END IF 

ICOAST - JCOAST 
IMAN - 1 
END IF 

IF (ICOAST .GT. NLEGS ) 

WRITE ( 6 ,*) 

IS ION' 

STOP 
END IF 


THEN 

YOU HAVE EXCEEDED THE NUMBER OF COASTS IN THIS MIS 


IREAD .EQ. 1) THEN 
THEN 


IF ( ITIME .EQ. 2 .OR 
IF (IREAD .EQ. 0) 

IMANS - IMAN- 1 
IND - 1 
DO I ■ 1,3 
DO J • 1,3 

ASV ( I , J) - A ( I , J) 

END DO 
END DO 
WPSV - WP 
WQSV - WQ 
WRSV - WR 
TIMESV - TIME 
PTIMESV - PTIMI 
END IF 
ITIMEF - 1 
NAMEZ(IND) - NAME 
ISYSZ(IND) - ISYS 
STIMEZ { IND) - STIME 
ITIMEZ ( IND) - ITIME 
DO Z • 1,3 

POINTZ (IND, I) - POINT ( I ) 
IPOINTZ CIND, I) - IPOINT(I) 
RATEZ (IND, I) - RATE (I) 
IRATEZ (IND, I) - IRATE (I) 
ACCELZ (IND, I) - ACCEL (I) 
IACCELZ ( IND , I ) - I ACCEL ( I ) 
IF (I .NE. 3) THEN 

SLEWZ ( IND, I) - SLEW ( I ) 
ISLEWZ (IND, I) - ISLEW(I) 
ROLLZ ( IND, I) - ROLL (I) 
IROLLZ (IND, I) - IROLL(I) 
END IF 
END DO 

IND - IND + 1 
IREAD - 1 

IF (ITIME .EQ. 1) THEN 
IREAD - 2 
END IF 
END IF 

ELSE IF (IREAD . EQ . 2) THEN 
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IF ( IMAN-IMANS . EQ . 1) THEN 
DO I - 1,3 
DO J - 1, 3 

A { I , J) - ASV { I , J) 

END DO 
END DO 
WP - WPSV 
WQ - WQSV 
WR - WRSV 
TIME - TIMESV 
PTIME - PTIMESV 
END IF 

NAME - NAMEZ ( I MAN- I MANS) 

I SYS - ISYSZ ( I MAN- I MANS) 

STIME - STIMEZ ( I MAN- I MANS ) 

I TIME - ITIMEZ (IMAN-IMANS) 

DO I - 1, 3 

POINT (I) - POINTZ (IMAN-IMANS, I) 

IPOINT ( I ) - IPOINTZ (IMAN-IMANS, I) 

RATE (I) - RATEZ (IMAN-IMANS, I) 

IRATE (I) - I RATEZ (IMAN-IMANS, I) 

ACCEL (I) - ACCELZ (IMAN-IMANS, I) 

I ACCEL ( I ) - I ACCELZ (IMAN-IMANS, I) 

IF (I .NE. 3) THEN 

SLEW (I) - SLEWZ (IMAN-IMANS, I) 

ISLEW(I) - I SLEWZ (IMAN-IMANS, I) 

ROLL (I) - ROLLZ (IMAN-IMANS, I) 

IROLL(I) - IROLLZ (IMAN-IMANS, I) 

END IF 
END DO 

IF (ITIMEF .EQ. 0 .AND. ABS (TINC) . LT . TTOL .AND. IMAN - IMANS 
1 .EQ. IND - 1) THEN 
IREAD - 0 
I TIME - 0 
END IF 
END IF 

IF (IMAN .EQ. 1) THEN 

WRITE (13,*) '--BEGINNING COAST ' , ICOAST 
WRITE (6,*) '--BEGINNING COAST ICOAST 
END IF 

WRITE (13,*) ' **BSGINNING MANEUVER ' , IMAN 
WRITE (6,*) ' **BEGINNING MANEUVER ' , IMAN 

CHECK 1ST MANEUVER 

IF (ICOAST .EQ. 1 .AND. IMAN .EQ. 1) THEN 
IF ( IPOINT ( 1 ) .EQ. 2) THEN 

CALL ROTATE (A, SRA, -SDEC, 0.0, 3,2,0) 

CALL GETPROJ (TIME, A, ROT) 

CALL ROTATE (A, 0 . 0 , 0 . 0 , ROT+RBURN, 0,0,1) 

ELSE IF ( IPOINT (1) . EQ . 1 .AND. IPOINT(2) .EQ. 1 .AND. 

1 IPOINT (3) .EQ. 1) THEN 

CALL POINTER (TIME, POINT, IPOINT, I SYS, A) 

ELSE IF (ISYS .EQ. 4 .AND. IPOINT(l) .EQ. 1 .OR. IPOINT(2) 

1 .EQ. 1) THEN 

CALL POINTER (TIME, POINT, IPOINT, ISYS, A) 

ELSE 

WRITE (6,*) 'YOU HAVE ENTERED AN INCORRECT OR INCOMPLETE SE 
IT OF INITIAL CONDITIONS' 

END IF 

CALL QUAT (A, Q0, Ql, Q2,Q3) 


IF (ISYS 

• EQ. 

3) THEN 


PSI - 

AT AN 2 

(A(l, 2) , 

A<1,D) 

THT - 

ASIN 

(“A(l, 3) ) 


PHI - 

AT AN 2 

(A(2, 3) , 

A(3, 3) ) 
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CALL POINTER (TIME+TDirF, POINT, IFOINT f I SYS, B) 

P3IP - AT AN 2 <B<1,2) ,B<1, 1) ) 

THTP - ASIN (-B (1, 3) ) 

PHIP - ATAN2 (B ( 2 , 3 ) , B (3 , 3) ) 

psid - (psip-psi) / TDirr 

THTP - {THTP -THT) / TDIFF 

PHID - (PHIP-PHI) / TD IFF 

WP - PHID - PSID * SIN(THT) 

WQ - THTD * COS (PHI) + PSID * COS (THT) * SIN(PHI) 

WR - PSID * COS (THT) * COS (PHI) - THTD * SIN (PHI) 

ELSE 

WP - 0 . 0 
WQ - 0.0 
WR - 0 . 0 
END IF 

CALL OUTPUT ( ITIMEF , TIME r A, WP , WQ, WR, PTIME) 

END IF 

C CHECK THE STATION KEEPING TIME FOR THIS MANEUVER 

IF (ITIME .EQ. 2) THEN 
XTIME - TIME 
MAN - I MAN 
STIME - TSTAY(IMAN) 

IF (STIME .EQ. 0.0) IPRNT - 0 
END IF 

C THIS SECTION Or CODE HANDLES THE CASE WHERE A POINTING COMMAND HAS 
C BEEN ISSUED AND NOW THE VEHICLE MUST STOP ANY CURRENT MOTION THAT IT 
C HAS AND THEN SLEW TO THE COMMANDED ATTITUDE 

IF (IPOINT ( 1 ) .NE. 0 .OR. IPOINT(2) .NE. 0 .OR. IPOINT<3) .NE. 

1 0 ) THEN 

C THE FIRST PART HERB IS THE STOPPING OF ANY ROLL AND/OR SLEW RATE 
C THAT MAY BE PRESENT FROM THE PREVIOUS MANEUVER 

WRITE (13,*) ' STOPPING MOTION TIME, WP, WQ, WR , TIME , WP , WQ, WR 

CALL QUAT (A, Q0, Ql, Q2, Q3) 

I EVENT - 0 

10 IF ( IROLL (2) .EQ. 0) THEN 

WP - 0.0 
TTSR » 0.0 
ELSE 

IF (WP .LT. 0.0) THEN 
SROLL - -ROLL ( 1) 

SACCKt - -ROLL (2) 

ELSE 

SROLL - ROLL ( 1 ) 

SAC CEL - ROLL (2) 

END IF 

TTSR - WP / 3 AC CEL 
END IF 

IF ( ISLEW (2) .EQ. 0) THEN 
WQ - 0 . 0 

WR - 0.0 
TT3S - 0.0 
ELSE 

SLEWR - (WQ**2 + WR**2) ** 0.5 
IF (WR .NE. 0.0 .OR. WQ . NE . 0.0) THEN 
SLEWA - ATAN2 (WR, WQ) 

END IF 

TTSS - SLEWR / SLEW(2) 

END IF 

IF (TTSS .EQ. 0.0 .AND. TTSR .EQ. 0.0) THEN 
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I EVENT • 3 

ELSE IF { I EVENT . LE . 1) THEN 

I EVENT - 1 

IF (TTSR .GT. TTSS ) THEN 
T EVENT - TTSS 
IHIGH - 1 
ELSE 

T EVENT - TTSR 
IHIGH - 2 
END IF 
END IF 

IF { I EVENT .NE. 3) THEN 
IF {TINT . LT. TEVENT) THEN 
DELT - TINT 
ELSE 

DELT - TEVENT 
IF ( I EVENT . EQ. I) THEN 
I EVENT - 2 

IF (IHIGH .EQ. 1) THEN 
TEVENT - TTSR 
ELSE 

TEVENT - TTSS 
END IF 
ELSE 

I EVENT - 3 
END IF 
END IF 

IF (TIME + DELT .GT. PTIME) THEN 
IF (WP .NE. 0.0) THEN 

ANGTRAVR - WP * (PTIME-TIME) - 0.5 * SACCEL * (PTIME - 
1 TIME ) **2 

WPP - WP - SACCEL * (PTIME-TIME) 

ELSE 

WPP - WP 
END IF 

IF (SLEWR .NE. 0.0) THEN 

ANGTRAVS - SLEWR * (PTIME-TIME) - 0.5 * SLEW (2) * (PTIME 
I -TIME) 

SLEWR - SLEWR - SLEW (2) * (PTIME-TIME) 

WRP - SLEWR * SIN(SLEWA) 

WQP - SLEWR * COS (3LEWA) 

ELSE 

WRP - WR 
WQP - WQ 
END ir 

THTDX - (WP + WPP) * 0.5 

THTDY - (WQ + WQP) * 0.5 

THTDZ - (WR + WRP) * 0.5 

DELT • DELT - (PTIME-TIME) 

CALL QUATUP (THTDX, THTDY , THTDZ , PTIME-TIME, Q0 , Q1 , Q2 , Q3 , A) 
TEVENT - TEVENT - (PTIME-TIME) 

TIME - PTIME 
WP - WPP 
WQ - WQP 
WR - WRP 

CALL OUTPUT ( ITIMEF, TIME, A, WP, WQ, WR, PTIME) 

GOTO 10 
ELSE 

TEVENT - TEVENT - DELT 
TIME - TIME + DELT 
IF (WP .NE. 0.0) THEN 

ANGTRAVR - WP * DELT - 0.5 * SACCEL * DELT ** 2 

WPP - WP - SACCEL * DELT 

ELSE 

WPP - WP 
END IF 
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Iff ( SLEWR . NE . 0.0) THEN 

ANGTRAV3 - SLEWR * DELT - 0.5 * SLEW<2) * DELT ** 2 
SLEWR - SLEW* - SLEW < 2 ) * DELT 

WRP - SLEWR * SIN(SLEWA) 

WQP - SLEWR * COS(SLEWA) 

ELSE 

WRP — WR 
WQP - WQ 
END IF 

THTDX - (WP + WPP) * 0.5 
THTDY * {WQ + WQP) * 0.5 
THTD2 - (WR + WRP) *0.5 

CALL QUATUP (THTDX, THTDY, THTDZ , DELT, Q0 , Q1 , Q2 , Q3 , A) 
IF (DELT . NE. TINT) THEN 
IF (I EVENT .EQ. 3) THEN 
WP - 0 . 0 
WQ - 0 . 0 
WR - 0.0 
SLEWR -0.0 

ELSE If (IHIGH .EQ. 1) THEN 


WQ - 

0.0 

WR - 

0.0 

SLEWR - 

WP - 

WPP 

ELSE 


WP - 

0.0 

WQ - 

WQP 

WR - 

WRP 

END IF 



ELSE 

WP - WPP 
WQ - WQP 
WR - WRP 
END IF 
GOTO 10 
END IF 
ELSE 

WP - 0.0 
WQ - 0.0 
WR - 0.0 
END IF 


WRITE <13,*) ' MOTION STOPPED, TIME - ' , TIM* 

C NOW THAT ANY MOTION LEFT OVER FROM THE PREVIOUS MANEUVER HAS BEEN 
C NULLED OUT, THE NEXT OBJECTIVE IS TO GET INTO THE PROPER ROLL ATTITUDE 
IF (ISYS .NE. 4) THEN 

CALL ROLLER (TIME, PTIME, A, IPOINT, POINT, ROLL, IROLL, ITIMEF, WP, 

1 ISYS) 


END IF 

C NOW THAT THE DESIRED ROLL ATTITUDE HAS BEEN REACHED, THE SLEWING 
C MOTION TAKES PLACE 

RDELAY - 0.0 
FTIME - TIME 
TV1 (1) - A ( 1 , 1 ) 

TV1 (2) - A (1 , 2) 

TV1 (3) - A ( 1 , 3) 

'50 DO I - 1,3 

DO J - 1,3 

IF (I .EQ. J) THEN 
B ( I , J) - 1.0 
ELSE 

B ( I , J) - 0.0 
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END IF 
END DO 
END DO 

IF (IPOINT(l) .EQ. 2) THEN 

CALL ROTATE (B, SRA, -SDEC, 0 . 0, 3, 2 , 0) 

ELSE IF (ISYS .EQ. 1) THEN 

CALL ROTATE (B, POINT (1) , -POINT (2) ,0.0, 3,2,0) 

ELSE IF ( I SYS .EQ. 2) THEN 

CALL SUNV (FTIME, STJNRA, SUNDEC) 

CALL ROTATE < B , SUNRA, -SUNDEC , 0 . 0 , 3 , 2 , 0 ) 

CALL ROTATE (B, POINT ( 1 ) , -POINT (2) ,0.0, 3,2,0) 

ELSE IF { ISYS .EQ. 3) THEN 

CALL GETSTATE ( FTIME , X , DUM1 , DUM2 , T1 , T2 ) 

ANG1 - ATAN2 <X(2),X(1)) 

ANG2 - ATAN2 (X(3),(X(1)**2 + X(2)**2)**0.5) 

CALL ROTATE (B , ANG 1 , - ANG2 -0 . 5 *P I , 0 . 0 , 3 , 2 , 0 ) 

CALL ROTATE (B, POINT (1) , -POINT (2) ,0.0, 3, 2,0) 

ELSE IF (ISYS .EQ. 4) THEN 

CALL ROTATE ( B , SANG1 , - SANG2 ,0.0, 3, 2,0) 

END IF 

T 1 - TV1 ( 1 ) *B (1,1) + TV1 (2) *B<1, 2) + TV1 ( 3 ) * B(l,3) 

IF (T1 .GT. 1.0) T1 - 1.0 
IF (T1 . LT. -1.0) T1 - -1.0 
SLEWANG - ACOS (Tl) 

IF (SLEWANG . EQ . 0.0 .OR. ABS(Tl) .EQ. 1.0) GOTO 666 
IF ( I SLEW ( 1 ) .EQ. 0 .AND. ISLEW{2) . EQ . 0) THEN 
TTS - 0.0 
WQ - 0 . 0 
WR - 0 . 0 

ELSE IF ( I S LEW ( 1 ) . EQ . 1 .AND. ISLEW(2) .EQ. 0) THEN 
TTS - SLEWANG / SLEW(l) 

ELSE IF (ISLEW(l) . EQ . 1 .AND. ISLEW(2) .EQ. 1) THEN 
TACCEL - SLEW ( 1 ) / SLEW<2) 

DACCEL - 0.5 * SLEW (2) * TACCEL ** 2 
DDECEL - SLEW ( 1 ) * TACCEL - DACCEL 
IF (SLEWANG . LT . DACCEL + DDECEL) THEN 
TTS - (4.0 * SLEWANG / SLEW(2)) ** 0.5 
Tl - TIME 4- TTS * 0.5 
T2 - Tl 
ELSE 

TTS - 2.0 * TACCEL + (SLEWANG -DACCEL -DDECEL) / 

1 SLEW ( 1 ) 

Tl - TIME ♦ TACCEL 
T2 - TIME + TTS - TACCEL 
END IF 
END IF 

IF (ISYS .EQ. 2 .OR. ISYS . EQ . 3) THEN 

IF (XBS (TIME+TTS+RDELAY-FTIME) .GT. TOL) THEN 
FTIME - TIME + TTS + RDELAY 
GOTO 50 
END IF 
ELSE 

FTIME - TIME 4- TTS 
END IF 

CI2M(1,1) - TV1(1) 

CI2M(1,2) - TV1 (2) 

CI2M (1,3) - TV1 (3) 

CI2M<3,1) - TV1 (2) * B ( 1 , 3) - TV1 (3) * B<1,2) 

CI2M (3,2) - TV1 (3) * B<1,1) - TV1(1) * B(l,3) 

CI2M<3,3) - TV1(1) * B ( 1 , 2) - TV1 (2) * B(l,l) 

XMAG • (CI2M<3, 1) **2 + CI2M(3,2)**2 + CI2M (3, 3) **2) **0 . 5 

CI2M (3,1) - CI2M (3, 1) / XMAG 
CI2M (3,2) - CI2M(3,2) / XMAG 
CI2M (3,3) - CI2M (3, 3) / XMAG 

CI2M<2,1) - CI2M (3, 2) *CI2M <1 , 3) - CI2M (3, 3) *CI2M (1 , 2 ) 
CI2M (2,2) - CI2M(3, 3) *CI2M{1, 1) - CI2M (3, 1) *CI2M (1, 3) 
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CI2M (2, 3) - CI2M(3,1)*CI2M<1,2) - CI2M (3 , 2 ) *CI2M ( 1 , 1) 
DO J “2,3 

ROLLM (2 , J) -0.0 
DO K — 1,3 

ROLLM ( 2 , J) - ROLLM { 2 , J) + CI2M(2,K) * A ( J, K) 

END DO 
END DO 

ROLLTEMP - AT AN 2 (ROLLM (2 , 3) , ROLLM (2,2) ) 

IF (TTS . EQ. 0.0) THEN 

CALL ROTATE (A, 0 . 0 , 0 . 0 , ROLLTEMP , 0 , 0 , 1 ) 

CALL ROTATE ( A r SLEWANG , 0 . 0 , 0 . 0 , 3 , 0 , 0 ) 

CALL ROTATE (A/ 0. 0,0.0,- ROLLTEMP ,0,0, 1 ) 

GOTO 666 
END IF 

ROLLI - -ROLLTEMP 
DO I - 1,3 
DO J - 1,3 

D ( I , J) - CI2M ( I , J) 

END DO 
END DO 

CALL ROTATE (D, SLEWANG, 0.0, 0.0, 3,0,0) 

IF (ISYS . NE . 4) THEN 

CALL GETPROJ (FTIME, B, ROT) 

IF ( IPOINT ( 1 ) .EQ. 2) THEN 

CALL ROTATE (B , 0 . 0 , 0 . 0 , ROT+RBURN, 0 , 0 , 1 ) 

ELSE 

CALL ROTATE (B, 0 . 0, 0 . 0, ROT+POINT (3) , 0, 0, 1) 

END IF 
ELSE 

IF { IPOINT ( 1 ) .EQ. 1) THEN 

CALL ROTATE (B, 0 . 0, 0 . 0, STARROT1+POINT (1) , 0, 0, 1) 
ELSE 

CALL ROTATE (B, 0 . 0 , 0 . 0, STARROT2+POINT (2) , 0, 0, 1) 
END IF 
END IF 
DO J - 2, 3 

ROLLM (2, J) - 0.0 
DO X - 1,3 

ROLLM (2, J) - ROLLM (2 , J) + D(2,K) * B(J,K) 

END DO 
END DO 

ROLLF - - ATAN2 ( ROLLM (2,3), ROLLM (2,2) ) 

DELTROLL - ROLLF - ROLLI 
SROLL - ROLL ( 1 ) 

S ACCEL - ROLL (2) 

IF (DELTROLL . GT . PI) DELTROLL - DELTROLL - 2.0*PI 
IF (DELTROLL . LT . -PI) DELTROLL • DELTROLL ♦ 2.0*PI 
IF (DELTROLL . LT . 0.0) THEN 
SROLL - -SROLL 
SACCEL - -SAC CEL 
END IF 

WPAVO - DELTROLL / TTS 

TRO - TIME 

WPMAX - WPAVG 

TR1 - TIME 

TR2 - TIME+TTS 

IF ( I ROLL (2 ) .EQ. 0) THEN 

ir (ABS (WPMAX) .GT. ABS (SROLL)) THEN 
WPMAX - SROLL 
TR2 - TIME+TTS 
END IF 
ELSE 

TEMPI - TTS**2 - 4.0 * DELTROLL /SACCEL 
IF (TEMPI .GE. 0.0) THEN 

TACC1- 0.5 * (TTS - TEMP 1 * * 0 . 5 ) 

WPMAX - SACCEL * TACC1 
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IF (ABS (WFMAX) . GT . AB3 (SROLL) ) THEN 
WFMAX - 3 ROLL 
TACC1 - SROLL / S ACCEL 
TR1 - TRO + TACC1 
ANGT - (TTS-TACC1) * WFMAX 
TR2 - TIME+TTS-TACC1 + (DELTROLL-ANGT) /WFMAX 
ELSE 

TR1 - TRO + TACC1 
TR2 - TIME+TTS - TACC1 
END IF 
ELSE 

TACC1 - (DELTROLL/ S ACCEL) **0.5 
IF (TACC1 .GT. SROLL/SACCEL) THEN 
TACC1 - SROLL/SACCEL 
TR1 - TRO + TACC1 
WFMAX - SROLL 

ANGT - (TTS-TACC1) * SROLL 

TR2 - TIME+TTS- TACC1 + (DELTROLL-ANGT) /SROLL 
ELSE 

TR1 - TRO + TACC1 
WFMAX - SACCEL * TACC1 
TR2 - TR1 
END IF 
END IF 
END IF 

IF (ISYS .EQ. 2 .OR. ISYS . EQ . 3) THEN 
RDELAY - TR2+TR1- TRO -FTIME 
IF (RDELAY . GT . TOL) GOTO 50 
END IF 

WRITE (13, * ) * BEGIN SLEWING, TIME, SLEWANG, DELTROLL-' , TIME, 

SLEWANG, DELTROLL 

IF ( I SLEW ( 1 ) .EQ. 1 .AND. ISLEW(2) .EQ. 0) THEN 
TTS - SLEWANG / SLEW(l) 

IF (TIME + TTS .GT. PTIMB) THEN 

ANGTRAV - SLEW ( 1 ) * (PTIME-TIME-TDITT*0 . 5) 

SLEWANG - SLEWANG - ANGTRAV 
CALL SLEWER (FTIME- . 5*TDITT, 

CI2M, ROLL TEMP , ANGTRAV, POINT, I POINT, ROLL I , 
PSIM, THTM, FHIM, A) 

ANGTRAV - SLEW ( 1 ) * TDIFT * 0.3 
SLEWANG - SLEWANG - ANGTRAV 
CALL SLEWER (FTIME, 

CI2M, ROLLTEMP, ANGTRAV, POINT, IPOINT, ROLLI , 

P S I , THT , PHI , A) 

DO I - 1,3 
DO J - 1,3 

B ( I , J) - CI2M ( I , J) 

END DO 
END DO 

ROLLTEMPS - ROLLTEMP 

ANGTRAV - SLEW ( 1) * TDIFT * 0.3 

CALL SLEWER (FTIME+ . 5*TDITT, 

B, ROLLTEMPS , ANGTRAV, POINT, IPOINT, ROLLI , 

PS IP, THTF, PHIP, C) 

F3ID - (PSIF-PSIM) / TDIFT 

THTD - (THTP-THTM) / TDIFT 

PHID - (PHIP-PHIM) / TDITT 

WP - PHID - PSID * SIN (THT) 

WQ - THTD * COS (PHI) + PSID * COS (THT) * SIN (PHI) 

WR - PSID * COS (THT) * COS (PHI) - THTD * SIN (PHI) 

TIME - PTIME 

CALL OUTPUT ( ITIMET, TIME, A, WP, WQ, WR, PTIME) 

GOTO 51 
ELSE 

TIME - TIME + TTS 
CALL SLEWER (TIME, 
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CI2M, ROLLTEMP, SLEWANG, POINT, IPOINT , ROLLI , 

PSI , THT, PHI , A) 

WQ - 0.0 
WR - 0 . 0 

IF (TIME . LE. TR2) THEN 
WP - WPMAX 

ELSE IF (TIME . GE . TR2+TR1-TR0) THEN 
WP - 0.0 
ELSE 

WP - -WPMAX / (TR1-TR0) * ( TIME- TR2 ) + WPMAX 

END IF 
END IF 

ELSE IF ( I SLEW ( I ) . EQ . 1 .AND. ISLEW(2) . EQ . 1) THEN 

IF (TIME + TTS .GT. PTIME) THEN 
IF <T1 .GT. PTIME) THEN 

IF (PTIME-TIME-TDIFF*0 . 5 . GT . 0.0) THEN 
ISG - 1 
ELSE 

ISG - -1 
END IF 

ANGTRAV - SLEWR * (PTIME-TIME-TDIFF*0 . 5) + 0.5 * 
S LEW ( 2 ) * ISG* (PTIME-TIME-TDIFF*0 . 5) **2 
SLEWR - SLEWR + SLEW(2) * (PTIME-TIME-0 . 5*TDIFF) 
ELSE IF (T2 .GT. PTIME) THEN 
IF (TIME .LT. Tl) THEN 

ANGTRAV - SLEWR * (Tl-TIME) + 0 . 5 * 

S LEW ( 2 ) * (Tl-TIME) **2 + 

SLEW ( 1 ) * (FTIME-T1 -TDIFF*0 . 5) 

ELSE 

ANGTRAV - 3 LEW ( 1 ) * (PTIME-TIME-TDIFF*0 . 5) 

END IF 

SLEWR - SLEW ( 1 ) 

ELSE 

IF (TIME .LT. Tl) THEN 

ANGTRAV - SLEWR * (Tl-TIME) +0.5 
* SLEW (2 ) * (Tl-TIME ) **2 
+ SLEW ( 1 ) * ( PTIME- T2-TD IFF *0 . 5) 

+ SLEW ( 1 ) * (T2-T1) - 0.5 * 

S LEW ( 2 ) * (PTIME-T2-TDIFF+0 .5) **2 
SLEWR - S LEW ( 1 ) - SLEW(2) * (PTIME-T2-TDIFF* 

* 0.5) 

ELSE IF (TIME .LT. T2) THEN 

ANGTRAV - SLEW (1 ) * (T2-TIME) -0 . 5* SLEW (2) * 
(PTIME-T2-TDIFF+0 . 5) **2 
SLEWR - S LEW ( 1 ) - SLEW (2) * (PTIME-T2-TDIFF * 

0.5) 

EL3S 

ANGTRAV - SLEWR * (PTIME-TIME-TDIFF* 0 .5) - 

0.5 * SLEW (2) * (PTIME-TIME-TDIFF* 

0 . 5) * *2 

SLEWR - SLEWR - SLEW (2) * (PTIME-TIME-TDIFF* 

0.5) 

END IF 
END IF 

SLEWANG - SLEWANG - ANGTRAV 
CALL SLEWER (PTIME- . 5*TDIFF, 

CI2M, ROLL TEMP , ANGTRAV, POINT, IPOINT, ROLLI , 
PSIM, THTM, PHIM, A) 


1 

2 


IF (Tl .GT. PTIME) THEN 

IF (SLEWR .LT. 0.0) THEN 
TT0 - -SLEWR/ SLEW (2) 

ANGTRAV - - (SLEWR * TT0 + 0.5 * SLEW (2) * TT0 
**2) + 0.5 * SLEW (2) * (TDIFF*0 . 5- 
TTO) **2 

SLEWR - SLEW (2 ) * (TDIFF*0 . 5-TTO) 
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ELSE 

ANGTRAV - SLEWR * (TDIFF*0.5) + 0.5 * 

S LEW ( 2 ) * (TDirr*0 .5) **2 
SLEWR - SLEWR + SLEW(2) * (0.5*TDIFF) 

END IF 

ELSE IF <T2 .GT. PTIME) THEN 

ANGTRAV - SLEW ( 1 ) * <TDIFF*0.5) , 

SLEWR - SLEW ( 1 ) 

ELSE 

ANGTRAV - SLEWR * <TDIFF*0.5) - 0.5 * SLEW (2) 

( TD IFF* 0 . 5 ) **2 

SLEWR - SLEWR - SLEW (2) * <TDIFF*0.5) 

END IF 

SLEWANG - SLEWANG - ANGTRAV 
CALL SLEWER (PTIME, 

CI2M, ROLLTEMP, ANGTRAV, POINT, IPOINT,ROLLI 
PSI , THT, PHI , A) 

DO I - 1, 3 

DO J - 1 , 3 

B ( I , J) - CI2M ( I , J) 

END DO 
END DO 

ROLLTEMPS - ROLLTEMP 

IF (T1 .GT. PTIME) THEN 

ANGTRAV - SLEWR * (TDIFF*0.5) + 0.5 * 

SLEW (2) * (TDIFF*0 .5) **2 
ELSE IF (T2 .GT. PTIME) THEN 

ANGTRAV - SLEW (1 ) * (TDIFF*0.5) 

ELSE 

ANGTRAV - SLEWR * <TDIFF*0.5) - 0.5 * SLEW (2) 
{TDIFF*0 . 5 ) **2 

END IF 

CALL SLEWER (PTIME+ . 5 *TDIFF, 

B , ROLLTEMPS , ANGTRAV, PO INT , IFOINT , ROLL I , 
PSIP , THTP, PHIP, C) 

PSID - (PSIF-PSIM) / TDIFF 
THTD - (THTP-THTM) / TDIFF 
PHID - (PHIP-PHIM) / TDIFF 
WP - PHID - PSID * SIN (THT) 

WQ - THTD * COS (PHI ) + PSID * COS (THT) * SIN(PHI) 

WR - PSID * COS (THT) * COS (PHI) - THTD * SIN (PHI) 

TTS - TTS - (PTIMK-TIME) 

TIME - PTIME 

CALL OUTPUT ( ITIMEF, TIME, A, WP, WQ, WR, PTIME) 

GOTO 60 
ELSE 

TIME - TIME + TTS 
CALL SLEWER (TIME, 

CI2M, ROLLTEMP , SLEWANG, POINT, IFOINT, ROLL I 
PSI, THT, PHI, A) 

WQ - 0.0 
WR - 0.0 

IF (TIME .LT. TR2) THEN 

WP - WPMAX 

ELSE IF (TIME . GT . TR2+TR1-TR0) THEN 
WP - 0.0 
ELSE 

WP - -WPMAX / (TR1-TR0) * (TIMB-TR2) + WPMAX 
END IF 
END IF 
END IF 

WRITE (13, * ) ' END SLEWING MOTION , TIME-', TIME 
CALL ROLLER (TIME, PTIME, A, IFOINT, POINT, ROLL, IROLL, ITIMEF, WP, 
ISYS) 



o o 


C AT THIS POINT THE DESIRED POINTING ATTITUDE SHOULD HAVE BEEN ACHIEVED 
C AND THE CURRENT SLEW RATE Or 0 BUT A POSSIBLE NON- ZERO ROLL RATE 

C THE NEXT THING TO CONSIDER IS STATION KEEPING. THE ONLY STATION 
C KEEPING MODE WHERE THE ATTITUDE IS CHANGING IS THE LVLH STATION 
C KEEPING, THE OTHERS ARE INERTIALLY FIXED. THE ATTITUDE WITH RESPECT 
C TO THE SUN CHANGES SLIGHTLY WITH TIME, AND IF DRIFT FROM THE DESIRED 
C ATTITUDE IS A PROBLEM, THE USER SHOULD ENTER PERIODIC MANEUVER 
C CORRECTIONS TO MAINTAIN THE PROPER ATTITUDE. THE SLEW AND ROLL RATES 
C INVOLVED IN MAINTAINING A PARTICULAR SOLAR ATTITUDE ARE SO SMALL THAT 
C IT WAS FELT THAT PERIODIC CORRECTIONS WOULD BE MADE RATHER THAN TRY TO 
C MOVE AT THESE VERY SMALL PATES . 

IF { IPOINT { 1 ) . EQ. 2) THEN 

STIME - TIMEB (ICOAST) - TIME 
I TIME “ 1 
END IF 

IF ( ITIMEF .EQ. 1 .AND. ITIME . EQ . 1) THEN 
TINC - STIME - (TIME-XTIME) 

IF (ABS (TINC) .GT. TTOL) THEN 

TSTAY (MAN) - TSTAY (MAN) + TINC 
ELSE 

ITIMEF - 0 
END IF 

I MAN - MAN - 1 
ELSE IF (ITIME . NE . 0) THEN 
61 IF (TIME + STIME . GT . PTIME) THEN 

STIME - STIME - (PTIME-TIME) 

TIME - PTIME 
ELSE 

TIME - TIME + STIME 
STIME - 0.0 
END IF 

IF ( ISYS .EQ. 3) THEN 

CALL LVLH ( T IME - TD IFF * 0 . 5 , POINT, IPOINT, A, PSIM, THTM, PHIM) 
CALL LVLH (TIME, POINT, IPOINT, A, PSI, THT, PHI) 

DO I - 1,3 
DO J - 1, 3 

B(I,J) - A ( I , J) 

END DO 
END DO 

CALL LVLH (TIME+TDIFF*0 . 5 , POINT, IPOINT, B, PSIP, THTP , PHIP) 

PSID - (PSIP-P3IM) / TDIIT 

THTD - (THTP -THTM) / TOUT 

PHID - (PHIF-PHIM) / TDIFF 

WP m PHID - PSID * SIN (THT) 

WQ - THTD * COS (PHI) + PSID * COS (THT) * SIN (PHI) 

WR - PSID * COS (THT) * COS (PHI) - THTD * SIN (PHI) 

ELSE 

WP - 0.0 
WQ - 0.0 

WR • 0.0 

END IF 

IF (TIME .EQ. PTIME) 

1 CALL OUTPUT (ITIMEF, TIME, A, WP, WQ, WR, PTIME) 

IF (STIME .NE. 0,0) GOTO 61 
END IF 

C AT THIS POINT EVERYTHING IS DONE FOR THIS MANEUVER IF IT IS A 
C POINTING COMMAND 

ELSE 


HERE A RATE COMMANDED MANEUVER WILL BE HANDLED 

WRITE (13,*) 'BEGIN RATE COMMAND, TIME-' , TIME 
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BRATE ( 1 ) - WP 

BRATE (2) - WQ 

BRATE ( 3 ) - WR 

TSTOP - 9 . 9 9E9 
DO I « 1,3 

IACC<I) - 0 

IF (IRATE (I) .EQ. 1 .AND. IACCEL(I) . EQ . 0) THEN 
BRATE ( I ) - RATE < I ) 

TACC(I) - 0.0 

ELSE IF (IRATE (I) . EQ . 1 .AND. I ACCEL (I) . EQ . I) THEN 
IF (BRATE (I) .GT. PATE (I)) THEN 
SACC(I) * -ACCEL (I) 

ELSE 

SACC(I) - ACCEL (I) 

END IF 

* TACC ( I ) - (RATE (I) -BRATE (I) ) / SACC ( I ) 

I ACC < I ) - 1 

END IF 
END DO 
75 DELT - TINT 

I TEMP - 0 
DO I - 1,3 

IF ( I ACC ( I ) .EQ. 1 .AND. TACC (I) . LT . DELT) THEN 

DELT - TACC (I) 

ITEMP - I 
END IF 
END DO 

IF (TSTOP-TIME . LT . DELT) THEN 
DELT - TSTOP - TIME 
END IF 

IF (TIME + DELT . GT . PTIME) THEN 
DO I * 1,3 

IF ( I ACC ( I ) .NE. 0) THEN 

BRATEP(I) - BRATE (I) + SACC (I) * (PTIME-TIME) 

ELSE 

BRATEP (I) - BRATE ( I ) 

END IF 
END DO 

THTDX - (BRATEP (1) +BRATE (1) ) * 0.5 
THTDY - (BRATEP (2) +BRATE (2) ) * 0.5 

THTDZ - (BRATEP (3) +BRATE (3) ) * 0.5 

CALL QUATUP (THTDX, THTDY, THTDZ, PTIME-TIME, Q0, Ql, Q2 , Q3, A) 

TIME - PTIME 

BRATE ( 1 ) - BRATEP ( 1 ) 

BRATE (2) - BRATEP (2) 

BRATE ( 3 ) - BRATEP ( 3 ) 

CALL OUTPUT ( ITIMEF, TIME, A, BRATE ( 1) , BRATE (2) , BRATE (3) , PTIME) 
IF (IKEEP .EQ. 0) GOTO 70 
GOTO 75 
ELSE 

DO r - 1,3 

IF ( I ACC ( I ) .NE. 0) THEN 

BRATEP (I) - BRATE (I) + SACC (I) * (DELT) 

ELSE 

BRATEP ( I ) - BRATE ( I ) 

END IF 
END DO 

IF (ITEMP .NE. 0) THEN 
IACC( ITEMP) - 0 
END IF 

THTDX - (BRATEP (1) + BRATE (1) ) * 0.5 

THTDY - (BRATEP (2) +BRATE (2) ) * 0.5 

THTDZ - (BRATEP (3) +BRATE (3) ) * 0.5 

CALL QUATUP (THTDX , THTDY , THTDZ , DELT , Q0 , Ql , Q2 , Q3 , A) 

TIME - TIME + DELT 
BRATE (1) - BRATEP (1) 
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BRATE ( 2 ) - BRATEP ( 2 ) 

BRATE ( 3 ) - BRATEP ( 3 ) 

IF (IACCU) -EQ. 1 .OR. I ACC ( 2 ) . EQ . 1 .OR. IACC(3) . EQ . 1) 

1 THEN 

IKEEP - 0 ' 

GOTO 70 

ELSE IF ( ITIMEF . EQ . 1 .AND. ITIME . EQ . 1) THEN 

TINC * STIME - ( T I ME - X T I ME ) 

IF (ABS (TINC) . GT. TTOL } THEN 

TSTAY (MAN) * TSTAY (MAN) + TINC 
ELSE 

ITIMEF - 0 
END IF 

I MAN - MAN - 1 

ELSE IF (ITIME . EQ . 1) THEN 

IF (IKEEP .EQ. 0) THEN 
IKEEP - 1 

TSTOP - TIME + STIME 
END IF 

IF (TIME .LT. TSTOP) GOTO 75 
END IF 
END IF 

WP - BRATE (1) 

WQ - BRATE (2) 

WR - BRATE (3) 

END IF 

IMAN - I MAN + 1 

IF (TIME .GT. TIMEB (ICOAST) ) THEN 

WRITE (6,*) 'YOU HAVE DESIGNED COAST MANEUVERS DURING A BURN' 
STOP 
END IF 
GOTO 1000 
END 
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SUBROUTINE CONVERT ( STRN1 , LEN , LOC , DNUM1 ) 

CHARACTER STRN1 { 1 : LEN) 

CHARACTER NUMT(IO) 

CHARACTER SIGN 

CHARACTER MINUS , PLUS , COMMA, DECIML, DOLLAR, BLANK, NULL 
INTEGER LOC, POINT, LEN 
INTEGER CNT2 

DOUBLE PRECISION DNUM1 , VAL, VAL2 , AMT 
NULL-CHAR (0) 

BLANK" ' ' 

MINUS- ' - ' 

PLUS-' +' 

COMMA-' , ' 

DECIML-' . ' 

DOLLAR-' $' 

NUMT (10) -' 0' 

NUMT ( 1 ) — ' 1' 

NUMT (2) -' 2' 

NUMT < 3 ) - ' 3 ' 

NUMT (4) «' 4' 

NUMT (5) 5 f 
NUMT (6) 6' 

NUMT (7) «' 7 r 
NUMT (8) 8' 

NUMT ( 9) -' 9' s 

CNT2-0 

SIGN-PLUS 

VAL— 0 

VAL2-0 

IF (LOC. LT. 1) GOTO 10 
IF (LOC. GT. LEN) GOTO 10 
GOTO 15 

10 CONTINUE 

DNUM1-0 
RETURN 

15 CONTINUE 

POINT-LOQ-1 

20 CONTINUE 

POINT-POINT+1 
IF (POINT . GT . LEN) GOTO 10 
IF (STRN1 (POINT) . EQ . BLANK) GOTO 20 
IF(STRN1 (POINT) . EQ . PLUS ) GOTO 30 
IF (STRN1 (POINT) .EQ. MINUS) GOTO 30 
GOTO 50 

25 CONTINUE 

AMT- I CHAR ( STRN1 (POINT) ) 

AMT-AMT- 4 8 
VAL- VAL + AMT 
VAL— VAL * 1 0 
GOTO 40 

28 CONTINUE 

AMT- I CHAR ( STRN1 (POINT) ) 

AMT-AMT-48 
VAL2-VAL2+AMT 
CNT2-CNT2+1 
VAL 2 -VAL 2 * 1 0 
GOTO 70 

30 SIGN— STRN1 (POINT) 

40 CONTINUE 

POINT— POINT '♦•l 

IF (POINT. GT. LEN) GOTO 61 

50 CONTINUE 

IF (STRN1 (POINT) .EQ. COMMA) GOTO 40 
IF (STRN1 (POINT) .EQ. DOLLAR) GOTO 40 
IF (STRN1 (POINT) .EQ. BLANK) GOTO 40 
DO 60 1-1,10 


A-21 



IF($TRN1 (POINT) .EQ.NUMT(I) ) GOTO 25 

60 CONTINUE 

61 VAL-VAL/10 

IF (STRN1 (POINT) . NE . DEC I ML ) GOTO. 100 
70 CONTINUE 

POINT-POINT+1 

IF (POINT . GT . LEN) GOTO 85 

DO 80 1-1, 10 

IF (STRN1 (POINT) . EQ . NUMT (I) ) GOTO 20 
80 CONTINUE 

IF (STRN1 (POINT) .EQ. BLANK) GOTO 70 
85 VAL2-VAL2/10 

DO 90 I«1,CNT2 
VAL2-VAL2/10 
90 CONTINUE 

100 CONTINUE 

IF (POINT . GT . LEN) GOTO 120 
IF (STRN1 (POINT) .EQ. BLANK) GOTO 105 
IF (STRN1 (POINT) . EQ . PLUS ) GOTO 110 
IF (STPN1 (POINT) .EQ .MINUS) GOTO 110 
GOTO 120 
105 CONTINUE 

POINT“PO INT+1 
IF (POINT . GT . LEN) GOTO 120 
GOTO 100 
110 CONTINUE 

SIGN-STRN1 (POINT) 

120 CONTINUE 

DNUM1-VAL+VAL2 

IF ( SIGN . EQ . MINUS ) DNUM1*DNUM1 * (-1. ) 

RETURN 

END 


A-22 



SUBROUTINE GETPROJ (.TIME, A, ROT) 
IMPLICIT FEAL*8 (A-H, O-Z) 
DIMENSION A (3, 3) , SUNI (3) , SUNM<3) 
CALL SUNV (TIME, PA, DEC) 

SUNI ( 1 ) * COS (DEC) * COS (PA) 

SUNI (2) * COS (DEC) * SIN (PA) 

SUNI (3) = SIN (DEC) 

DO I * 1,3 

SUNM ( I ) =*0.0 
DO J * 1,3 

SUNM (I) = SUNM (I) + A ( I , J) 

END DO 
END DO 

ROT = ATAN2 ( SUNM ( 3 ) , SUNM ( 2 ) > 

RETURN 

END 


SUNI ( J) 
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SUBROUTINE GETSTATE ( T, XI , GI , THI , RAI , DEC I ) 

IMPLICIT RJEAL * 8 <A-H,0-Z) 

DIMENSION XI <3) ,GX (3) , THI (3) , VAR (11, 3) , VALUE (11) 

COMMON /COMl / DTIME (5000) , DX (5000 r 3) t DGACC (5000, 3) , DMACC (5000, 3} , 

1 IBRN (5000) , DRA (5000) , DDEC(5000) 

IF ( IFIP.ST . EQ. 0) THEN 
T 1 = DTIME ( 1 ) 

T2 - DTIME (2) 

T3 - DTIME (3) 

TC = DTIME ( 4 ) 

IC - 4 
END IF 

10 IF (T .GT. T2 .AND. T-Tl . GT . TC-T) THEN 
T1 - T 2 
T2 =■ T 3 
T3 - TC 
IC - IC + 1 
TC - DTIME ( IC) 

GOTO 10 
END IF 
DO I - 1,11 
DO J - 1, 3 

IF (I .LE. 3) THEN 

VAR ( I , J) - DX(IC-4+J,I) 

ELSE IF (I .LE. 6) THEN 

VAR ( I , J) - DGACC (IC-4 + J, 1-3) 

ELSE IF (I .LE. 9) THEN 

VAR ( I , J) - DMACC (IC-4+J, 1-6) 

ELSE IF (I .EQ. 10) THEN 
VAR ( I , J) - DRA(IC-4+J) 

ELSE 

VAR { I , J) - DDEC ( IC“ 4+ J) 

END IF 
END DO 
END DO 

IF (IBRN (ICO) .EQ. 1 .AND. IBRN (IC-2) . EQ . 1 .AND. IBRN(IC-l) 

1 .EQ. 0) THEN 
DO I - 1,11 

IF (I .GE. 7 .AND. I . LE . 9 .AND. T . GT . DTIME(IC-2)) THEN 
A - 0 . 0 

B - (DMACC ( IC, 1-6) -DMACC ( IC-1 , 1-6) ) 

1 / (DTIME (IC) -DTIME (IC-1) ) 

C - DMACC (IC, 1-6) - B- * DTIME (IC) 

ELSE 

A - 0.0 

B- ( VAR (1,1) -VAR (1,2) ) / (DTIME ( IC-3 ) -DTIME ( IC-2 ) ) 

C - VAR (1,1) - B * DTIME ( IC-3) 

END IF 

VALUE (I) » B * T + C 
END DO 

ELSE IF < IBRN (IC-3) . EQ . 0 .AND. IBRN(IC-2) .EQ. 1 .AND. 

1 IBRN (IC-1) .EQ. 1) THEN 

DO I - 1, 11 

IF (I .GE. 7 .AND. I . LE . 9 .AND. T . LT . DTIME (IC-2)) THEN 

A - 0.0 

B - (DMACC (IC-3, 1-6) -DMACC(IC-4, 1-6) ) 

1 / (DTIME (IC-3) -DTIME (IC-4) ) 

C - DMACC (IC-3, 1-6) - B * DTIME(IC-3) 

ELSE 

A - 0.0 

B- (VAR (1,2) -VAR ( I , 3 ) ) / (DTIME ( IC-2 ) -DTIME ( IC- 1) ) 

C - VAR (1,2) - B * DTIME (IC-2) 

END IF 

VALUE (I) — B * T + C 
END DO 
ELSE 
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w N> 


DO I - 1,11 

IF (I .GE. 7 .AND. I . LE . 9 .AND. IBRN(IC-3) . EQ . 0 .AND. 

1 IBRN ( IC-2 ) .EQ. 0 .AND. IBRN(IC-l) . EQ . 1) THEN 

A » 0.0 

B - (VAR (1,2) -VAR (1,3)) / (DTIME ( IC-2) -DTIME ( IC- 1 ) ) 

C - VAR (1,2) - B * DTIME (IC-2) 

ELSE IF (I .GE. 7 .AND. I . LE . 9 .AND. IBRN(IC-3) . EQ . 1 

1 .AND. IBRN ( IC-2 ) . EQ . 0 .AND. IBRN(IC-l) . EQ . 0) 

2 THEN 

A * 0 . 0 

B - (VAR (1,1) -VAR (1,2) ) / (DTIME ( IC- 3) -DTIME ( IC-2 ) ) 

C * VAR (1,1) - B * DTIME (IC-3) 

ELSE 

A - ( (VAR(I, 1) -VAR(I, 2) )* (DTIME (IC-3) -DTIME (IC-1) ) - 

(VAR (I, 1) -VAR (I, 3) ) * (DTIME (IC-3) -DTIME (IC-2) ) ) / 

( (DTIME (IC-3) * *2 -DTIME (IC-2) **2) * (DTIME (IC-3) - 

DTIME ( IC- 1 ) ) - (DTIME (IC-3) **2-DTIME (IC-1) ** 2 ) * 

(DTIME (IC-3) -DTIME (IC-2) ) ) 

B - (VAR (1,1) -VAR (I , 2) -A* (DTIME (IC-3) * *2 -DTIME (IC-2) **2) ) / 

1 (DTIME (IC-3) -DTIME (IC-2) ) 

C - VAR (1,1) - A * DTIME (IC-3) **2 - B * DTIME (IC-3) 

VALUE (I) -A*T**2+B*T+C 
END IF 
END DO 

END IF - 

DO I - 1, 11 

IF (I .LE. 3) THEN 
XI (I) - VALUE (I) 

ELSE IF (I .LE. 6) THEN 
GI (1-3) - VALUE (I) 

ELSE IF (I .LE. 9) THEN 
THI (1-6) - VALUE (I) 

ELSE IF (I .EQ. 10) THEN 
RAI - VALUE (I) 

ELSE 

DECI - VALUE (I) 

END IF 
END DO 
RETURN 
END 
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SUBROUTINE LVLH (TIME , POINT , IPOINT, A, PSI , THT, PHI ) 
IMPLICIT PJEAL*0 (A-H, O-Z) 

DIMENSION POINT (3) , IPOINT <3),A(3,3),X(3), DUMl (3) r DUM2 (3) 
COMMON/ COM3 /PI, TWOPI , PI02 
IF ( IPOINT ( 3 ) .EQ. 0) THEN 
CALL GETPROJ {TIME , A, ROT1 ) 

END IF 
DO I = 1, 3 

DO J - 1,3 

IF (I .EQ. J> THEN 
A ( I, J) * 1.0 
ELSE 

A (I, J) - 0.0 
END IF 
END DO 
END DO 

CALL GETSTATE < TIME , X , DUMl , DUM2 , PA, DEC) 

ANG1 * ATAN2 (X (2) , X (1) ) 

ANG2 * ATAN2 (X (3) , (X(l)**2+X(2)**2)**0.5) 

CALL ROTATE (A, ANG1 , -ANG2 - . 5 * P 1 , 0 . 0 , 3 , 2 , 0 ) 

CALL ROTATE (A, POINT ( 1 ) , -POINT (2) ,0.0, 3,2,0) 

CALL GETPROJ (TIME, A, ROT) 

IF ( IPOINT { 3 ) .EQ. 1) THEN 

CALL ROTATE ( A, 0 . 0 , 0 . 0 , ROT + POINT { 3 ) ,0,0,1) 

ELSE 

CALL ROTATE (A, 0 . 0, 0 . 0 , ROT -ROT 1 ,0,0,1) 

END IF 

PSI - ATAN2 ( A ( 1 , 2 ) ,A(1, 1) > 

THT - AS IN ( “A (1,3) ) 

PHI - ATAN2 (A (2 , 3) , A ( 3 , 3) ) 

RETURN 

END 
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SUBROUTINE OUTPUT ( ITIMEF , TIME , A, WP , WQ, WR, PTIME) 
IMPLICIT REAL * 8 (A-H,0-Z) 

COMMON / COM2 / PINT,TIMEO 
DIMENSION A (3, 3) f G (3) , TH (3) , DUM (3) 

PTIME - PTIME + PINT 
IF (ITIMEF .EG. 0) THEN 
CALL QUAT (A, QO , Q1 , Q2 , Q3 ) 

CALL GETSTATE (TIME, DUM, G, TH, T1 , T2 ) 

WRITE (31, 100) TIME, G (1) +TH (1) , G (2) +TH (2) , G (3) +TH (3) 

100 FORMAT {' ' , D14 . 8, 3 ( IX, D16 . 9) ) 

WRITE (32,100) TIME , G(l) ,G(2) , G ( 3 ) 

WRITE (33,100) TIME, TH (1) , TH (2 ) , TH (3) 

WRITE (34,100) TIME, WP, WQ, WR 

WRITE (35,101) TIME, Q0 , Q1 , Q2, Q3 

101 FORMAT ( r ' , D14 . 8 , 4 ( IX, D16 . 9) ) 

END IF 

RETURN 

END 
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SUBROUTINE POINTER ( TIME , POINT , IPO INT , I SYS , A) 

IMPLICIT REAL * 8 <A-H,0-Z) 

DIMENSION POINT (3),A(3,3),X<3>, IPOINT (3) , SV1 (3) , SV1M ( 3 / , SV2 (3) , 
1 SV2M ( 3 ) 

COMMON /COM 3 / P I , TWOP I , P 102 

COMMON /C0M7 / SANG1 , SANG2 , STARR0T1, STARR0T2, SV1 , SV2 
DO I * 1,3 
DO J ■ 1,3 

IF (I EQ. J) THEN 
A ( I, J) = 1.0 
ELSE 

A ( I , J) - 0.0 
END IF 
END DO 
END DO 

IF (ISYS .EQ. 1) THEN , 

CALL ROTATE (A, POINT ( 1 ) , -POINT (2) ,0.0, 3,2,0) 

CALL GETPROJ (TIME , A, ROT) 

CALL ROTATE (A, 0 . 0 , 0 . 0 , ROT^POINT ( 3 ) , 0 , 0 , 1 ) 

ELSE IF (ISYS -EQ. 2) THEN 

CALL SUNV (TIME, SUNRA, SUNDEC) 

CALL ROTATE (A, SUNRA, -SUNDEC , 0 . 0 , 3 , 2 , 0 } 

CALL ROTATE ( A, POINT ( 1 ) , -POINT ( 2 ) , 0 . 0 , 3 , 2 f 0 ) 

CALL GETPROJ (TIME, A, ROT) 

CALL ROTATE < A, 0 . 0 , 0 . 0 , ROT+POINT ( 3 ) , 0 , 0 , 1 ) 

ELSE IF (ISYS .EQ. 3) THEN 
CALL GETSTATE (TIME,X) 

ANG1 - ATAN2 (X(2),X(1)) 

ANG2 - ATAN2 (X ( 3 ) , (X ( 1 ) * * 2 + X(2)**2) ** 0.5) 

CALL ROTATE (A, ANG1 , -ANG2 -0.5*PI, 0.0, 3,2,0) 

CALL ROTATE (A, POINT ( 1 ) , -POINT (2 ) , 0 . 0 , 3 , 2 , 0 ) 

CALL GETPROJ (TIME, A, ROT) 

CALL ROTATE (A, 0 . 0 , 0 . 0 , ROT+POINT ( 3 ) ,0,0,1) 

ELSE IF (ISYS .EQ. 4) THEN 

CALL ROTATE (A, SANG1 , -SANG2 , 0 . 0 , 3 , 2 , 0 ) 

IF (IPOINT(l) .EQ. 1) THEN 

CALL ROTATE (A, 0 . 0, 0 . 0, STARROT1+POINT (1) , 0, 0, 1) 

ELSE 

CALL ROTATE (A, 0 . 0, 0 . 0, STARROT2+POINT (2) , 0, 0, 1) 

END IF 
END IF 
RETURN 
END 
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SUBROUTINE QUAT (COORD , QO , Q1 , Q2 , Q3 ) 

IMPLICIT FDAL*8 (A-H,0-Z) 

DIMENSION COORD (3,3) 

QO - 0.5 * {1.0 + COORD {1,1) + COORD (2,2) +„ COORD (3,3) ) **'0.5 
Q1 - (QO * QO - 0.5 * (COORD (2,2) + COORD<3,3))) ** 0.5 
IF ( COORD (2,3) - COORD (3,2) . LT . 0.0) THEN 

Q1 - -Q1 
END IF 

Q2 = (Q0 * Q0 - 0.5 * (COORD (1,1) + COORD(3,3))) ** 0.5 

IF (COORD (3,1) - COORD (1,3) . LT . 0.0) THEN 

Q2 = -Q2 
END IF 

Q3 * (Q0 * Q0 - 0.5 * (COORD (1,1) + COORD(2 r 2))) ** 0.5 

IF ( COORD (1,2) - COORD (2,1) . LT . 0.0) THEN 

Q3 - -Q3 
END IF 
RETURN 
END 
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SUBROUTINE QUATUP (THTDX, THTDY , THTDZ , DELTA, QO , Ql, Q2, Q3, A) 
IMPLICIT REAL* 8 (A-H,0-Z) 

DIMENSION A (3, 3) 

THTD - (THTDX* *2 + THTDY* *2 + THTDZ * *2 ) * * 0 . 5 
IF (THTD . NE. 0.0) THEN 

Q5 - COS (THTD*DELTA/2 . 0) 

Q6 * SIN ( THTD* DELTA/ 2.0) / THTD 

QOP = Q5 * QO - Q6 * (01 * THTDX + Q2 * THTDY + Q3 * THTDZ) 

Q1P » Q5 * Ql + Q6 * (QO * THTDX + Q2 * THTDZ - Q3 * THTDY) 

Q2P * 05 * Q2 + Q6 * (QO * THTDY - Ql * THTDZ + Q3 * THTDX) 

Q3P * 05 * Q3 + Q6 * (QO * THTDZ + Ql * THTDY - Q2 * THTDX) 

QO - QOP 

Ql * Q1P 

Q2 * Q2P 

Q3 * Q3P 

DQ - 0.5 * (1.0 - QO *Q0 - Q1*Q1 - Q2*Q2 - Q3*Q3) 

QO - QO * (1.0 + DQ) 

Ql - Ql * (1.0+ DQ) 

Q2 - Q2 * (1 . 0 + DQ) 

Q3 * Q3 * (1.0 + DQ) 

END IF 


A ( 1 , 1 ) 

m 

QO * QO 

+ Ql * 

' Ql - 

• Q2 * Q2 - Q3 * Q3 

A<1,2) 

m 

2.0 * (Ql 

* Q2 

+ Q3 

* QO) 

A(l, 3) 

m 

2.0 * (Ql 

* Q3 

- 02 

* QO) 

A ( 2 , 1) 

m 

2.0 * (Ql 

* Q2 

- 03 

* QO) 

A (2, 2) 

m 

QO * QO - 

Ql * 

Ql + 

Q2 * Q2 - Q3 * Q3 

A (2 , 3 ) 

« 

2.0 * (Q2 

* Q3 

+ Ql 

* QO) 

A(3, 1) 

m 

2.0 * (Ql 

* Q3 

+ Q2 

* QO) 

A<3,2) 

m 

2.0 * (Q2 

* 03 

- Ql 

* QO) 

A<3, 3) 

• 

QO * 00 - 

01 * 

01 - 

Q2 * Q2 + Q3 * Q3 


RETURN 

END 
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SUBROUTINE RMAN (JCOAST, JMAN, NAME, ISYS , POINT , IPOINT , SLEW, I SLEW, 

1 ROLL , I ROLL, RATE , IRATE , ACCEL , IACCEL, TIME , ITIME) 

IMPLICIT REAL* 8 (A-H,0-Z) 

COMMON/ COM3 /PI , TWOP I , PI02 
CHARACTER* 1 CTYPE , ATEMP 
CHARACTER* 4 0 NAME , TEMP 
CHARACTER* 60 ALPHA 

DIMENSION POINT (3) , IPOINT (3) , SLEW (2) , ISLEW (2) , ROLL (2) , IROLL (2) , 

1 PATE (3) , IRATE (3) , ACCEL ( 3 ) , IACCEL (3) 

DO I * 1,3 

POINT (I) = 0.0 

PATE ( I ) * 0.0 

ACCEL (I) “ 0.0 

IPOINT (I) * 0 

I RATE ( I ) - 0 

IACCEL (I) - 0 

IF (I .NE. 3) THEN 
SLEW (I) * 0.0 

ROLL (I) * 0.0 

ISLEW ( I ) - 0 

IROLL (I) - 0 

END IF 
END DO 

READ A BLANK LINE 
READ (20,*) 

GET COAST NUMBER 

READ (20, 110, END-77) JCOAST 

110 FORMAT ( 9X, 110 ) 

IF (JCOAST .LE. 0) THEN 

WRITE (6,*) 'YOU HAVE ENTERED A NON -POSITIVE COAST NUMBER : 

1 JCOAST 

77 STOP 

END IF 

. READ (20,111) JMAN 

111 FORMAT ( 12X, 110) 

IF (JMAN .LE. 0) THEN 

WRITE (6,*) 'YOU HAVE ENTERED A NON-POSITIVE MANEUVER NUMBER : 

1 ' , JMAN 
STOP 
END IF 

READ (20,112) NAME 

112 FORMAT ( 6X, A40 ) 

READ (20,113) CTYPE 

113 FORMAT (29X,A1) 

IF (CTYPE .EQ. 'A' .OR. CTYPE . EQ . 'a') THEN 

ISYS - 1 

ELSE IF (CTYPE . EQ . 'B' .OR. CTYPE . EQ . 'b') THEN 

ISYS - 2 

ELSE IF (CTYPE . EQ . 'C' .OR. CTYPE . EQ . ' c' ) THEN 

ISYS - 3 

ELSE IF (CTYPE . EQ . ' D' .OR. CTYPE . EQ . ' d' ) THEN 

ISYS - 4 

ELSE IF (CTYPE . EQ . ' ') THEN 

ISYS - 0 
ELSE 

WRITE (6,*) 'YOU HAVE ENTERED AN IMPROPER COORDINATE SYSTEM : ' 

1 , CTYPE 

STOP 
END IF 
READ (20,*) 

READ (20,114) ALPHA 

114 FORMAT (17X,A60) 
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IF ( ALP HA (1:1) . EQ . 

' B ' 

.OR. ALPHA (1:1) . EQ . 

'b' ) 

THEN 

IPOINT (1) - 2 





ELSE IF (ALPHA (1:1) 

.EQ. 

' ' ) THEN 



IPOINT ( 1 ) - 0 






IPOINT ( 2 ) - 0 

IPOINT ( 3 ) - 0 


ELSE 

IF ( ALPHA (1:1) . EQ . 'X' .OR. ALPHA (1:1) . EQ . 'x') THEN 

IPOINT ( 1 ) =» 0 

I HUM - 3 
ELSE 

INUM * 2 

10 IF (ALPHA ( INUM: INUM) . NE . .AND. ALPHA { INUM : INUM) . NE . 

1 ' ' ) THEN 

INUM - INUM + 1 

• IF (INUM .EQ. 61) GOTO 11 

GOTO 10 
END IF 

11 TEMP (1:40)- ' ' 

TEMP - ALPHA ( 1 : INUM- 1 ) 

CALL CONVERT (TEMP, 40, 1 , T1 ) 

POINT ( 1 ) - T1 

IPOINT (1) - 1 
INUM - INUM + 1 

IF (INUM .GT. 60 .OR. ALPHA ( INUM- 1 : INUM- 1 ) . EQ . ' ') GOTO 40 

END IF 

IF (ALPHA (INUM: INUM) . EQ . ' ') THEN 

IPOINT (2) - 0 

IPOINT (3) - 0 
ELSE 

IF (ALPHA (INUM: INUM) . EQ . 'X' .OR. ALPHA ( INUM : INUM) . EQ . 

1 ' x' ) THEN 

IPOINT (2) - 0 
INUM - INUM + 2 
ELSE 

INUM0 - INUM 
INUM • INUM + 1 

20 IF (ALPHA (INUM: INUM) . NE . ' , ' .AND. ALPHA ( INUM: INUM) .NE. 

1 ' ' ) THEN 

INUM - INUM + 1 
ir (INUM .EQ. 61) GOTO 21 
GOTO 20 
END IF 

21 TEMP (1 : 4 0 ) - ' ' 

TEMP - ALPHA (INUM0 : INUM-1) 

CALL CONVERT (TEMP , 40 , 1 , T1 ) 

POINT (2) - T1 
IPOINT (2) - 1 
INUM • INUM + 1 

IF (INUM .GT. 60 .OR. ALPHA (INUM-1 : INUM-1) .EQ. ' ') 

‘1 GOTO 40 

END IF 

IF (ALPHA (INUM: INUM) . EQ . ' ') THEN 

IPOINT (3) - 0 
ELSE 

TEMP (1:40) - ' ' 

TEMP -ALPHA (INUM: 60) 

CALL CONVERT (TEMP , 40 , 1 , T1 ) 

POINT ( 3 ) - T1 

IPOINT (3) - 1 
END IF 
END IF 
END IF 

40 READ (20,114) ALPHA 

IF (ALPHA (1:1) . EQ . ' ' ) THEN 

I SLEW ( 1 ) - 0 
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I SLEW ( 2 ) - 0 

ELSE 

IF (ALPHA (1:1) . EQ . ' X' . OR . ALPHA(1:1) . EQ . 'x') THEN 

. I SLEW ( I ) - 0 

INUM - 3 
ELSE 

INUM - 2 

30 IF (ALPHA ( INUM: INUM) . NE . .AND. ALPHA ( INUM : INUM) . NE . 

1 ' ' ) THEN 

INUM * INUM + 1 
IF (INUM .EQ. 61) GOTO 31 
GOTO 30 
END IF 

31 TEMP (1:40) » ' ' 

TEMP - ALPHA (1 : INUM- 1) 

CALL CONVERT (TEMP , 4 0 , 1 , T 1 ) 

SLEW (1) -■ T1 

I SLEW ( 1 ) - 1 

INUM - INUM + 1 

IF (INUM .GT. 60 .OR. ALPHA ( INUM- 1 : INUM- 1 ) . EQ . ' ') GOTO 50 

END IF 

IF (ALPHA (INUM: INUM) . EQ . ' ') THEN 

I SLEW ( 2 ) - 0 

ELSE 

TEMP (1:40) - ' ' 

TEMP -ALPHA (INUM: 60) 

CALL CONVERT (TEMP , 4 0 , 1 , T1 ) 

SLEW ( 2 ) - T1 

I SLEW ( 2 ) - 1 

END IF 
END IF 

50 READ (20,114) ALPHA 

IF (ALPHA (1:1) . EQ . ' ') THEN 

IROLL(l) - 0 
IROLL ( 2 ) - 0 
ELSE 

IF (ALPHA (1:1) . EQ . ' X' . OR. ALPHA(1:1) .EQ. 'x') THEN 

IROLL (1) - 0 
INUM - 3 
ELSE 

INUM • 2 

230 IF (ALPHA ( INUM : INUM) . NE . .AND. ALPHA ( INUM : INUM) . NE . 

1 ' ' ) THEN 

INUM - INUM + 1 
IF (INUM .EQ. 61) GOTO 231 
GOTO 230 
END IF 

231 TEMP (1:40) - ' ' 

TEMP - ALPHA ( 1 : INUM- 1 ) 

CALL CONVERT (TEMP, 40 , 1 , T1 ) 

ROLL ( 1 ) - T1 
IROLL (1) - 1 
INUM - INUM + 1 

IF (INUM .GT. 60 .OR. ALPHA ( INUM- 1 : INUM- 1 ) .EQ. ' ' ) GOTO 250 

END IF 

IF (ALPHA (INUM: INUM) . EQ . ' ' ) THEN 

IROLL (2) - 0 
ELSE 

TEMP (1:40) - ' ' 

TEMP - ALPHA (INUM: 60) 

CALL CONVERT ( TEMP , 4 0 , 1 , T1 ) 

ROLL (2) - T1 

IROLL (2) - 1 
END IF 
END IF 

2 5 0 READ (20, * ) 
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P.EAD (20,116) ALPHA 

116 FORMAT ( 2 OX , A60 ) 

IF (ALPHA (1:1) . EQ . ' '} THEN 

IPATE (1) - 0 

I PATE ( 2 ) - 0 

IRATE (3) « 0 

ELSE 

IF (ALPHA (1:1) . EQ . 'X' .OR. ALPHA ( 1 : 1 ) . EQ . 'x') THEN 

IPATE (1) - 0 

I HUM * 3 
ELSE 

I HUM = 2 

310 IF (ALPHA (INUM: INUM) . NE . .AND. ALPHA ( INUM : INUM) . NE . 

1 ' ' ) THEN 

INUM * INUM + 1 
IF (INUM .EQ. 61) GOTO 311 
GOTO 310 
END IF 

311 TEMP (1:40) - ' ' 

TEMP - ALPHA (1 : INUM-1) 

CALL CONVERT ( ALPHA, 4 0 , 1 , T 1 ) 

RATE (1) - T 1 

IRATE (1) - 1 

INUM - INUM + 1 

IF (INUM .GT. 60 .OR. ALPHA ( INUM- 1 : INUM- 1 ) . EQ . ' ' ) GOTO 340 

END IF 

IF (ALPHA (INUM: INUM) . EQ . ' ') THEN 

IRATE (2) - 0 

IRATE (3) - 0 
ELSE 

IF (ALPHA (INUM: INUM) . EQ . 'X' .OR. ALPHA ( INUM : INUM) . EQ . 

1 ' x ' ) THEN 

IRATE (2) - 0 
INUM - INUM + 2 
ELSE 

INUM0 - INUM 
INUM - INUM + 1 

320 IF (ALPHA (INUM: INUM) . NE . ' , ' .AND. ALPHA ( INUM: INUM) 

1 . NE . ' ' ) THEN 

INUM - INUM + 1 
ir (INUM .EQ. 61) GOTO 321 
GOTO 320 
END IF 

321 TEMP (1:40) - ' ' 

TEMP - ALPHA ( INUM0 : INUM-1) 

CALL CONVERT (TEMP , 40 , 1 , T1 ) 

RATE (2) - T1 
IRATE (2) - 1 
INUM - INUM + 1 

IF (INUM .GT. 60 .OR. ALPHA ( INUM-1 : INUM-1 ) .EQ. ' ') 

1 GOTO 340 

END IF 

IF (ALPHA (INUM: INUM) . EQ . ' ') THEN 

IRATE (3) - 0 
ELSE 

TEMP (1:40) - ' ' 

TEMP - ALPHA(INUM: 60) 

CALL CONVERT (TEMP , 40 , 1 , T1 ) 

RATE (3) - T1 
IRATE (3) - 1 
END IF 
END IF 
END IF 

340 READ (20,117) ALPHA 

117 FORMAT (19X,A60) 

IF (ALPHA (1:1) . EQ . ' ') THEN 
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410 


411 


420 


421 


4 40 

120 


I AC CEL (1) - 0 

I ACCEL ( 2 ) - 0 

I ACCEL ( 3 ) - 0 

ELSE 

IF (ALPHA (1:1) . EQ . r X' .OR. ALPHA (1:1) . EQ . ' x' ) THEN 

I ACCEL ( 1 ) - 0 

I HUM » 3 
ELSE 

INUM - 2 

IF (ALPHA (INUM: INUM) . NE . .AND. ALPHA ( INUM : INUM) . NE . 

1 ' ' ) THEN 

INUM - INUM + 1 
IF (INUM .EQ. 61) GOTO 411 
GOTO 410 
END IF 

TEMP (1:40) * ' ' 

TEMP - ALPHA (1 : INUM** 1) 

CALL CONVERT < TEMP , 40 , 1 , T1 ) 

ACCEL (1) * T1 

IACCEL(l) - 1 
INUM - INUM + 1 

IF (INUM .GT. 60 .OR. ALPHA ( INUM- 1 : INUM- 1 ) . EQ . ' ' ) GOTO 440 

END IF 

IF (ALPHA (INUM: INUM) . EQ . ' ') THEN 

I ACCEL (2) * 0 
IACCEL ( 3 ) - 0 
ELSE 

IF (ALPHA (INUM: INUM) . EQ . 'X' .OR. ALPHA ( INUM : INUM) . EQ . 

1 ' x ' ) THEN 

IACCEL (2) - 0 
INUM - INUM + 2 
ELSE 

INUM0 - INUM 
INUM - INUM + 1 

IF (ALPHA (INUM: INUM) . NE . ' , ' .AND. ALPHA ( INUM : INUM) 

1 . NE . ' ' ) THEN 

INUM - INUM + 1 
IF (INUM .EQ. 61) GOTO 421 
GOTO 420 
END IF 

TEMP (1:40) - ' ' 

TEMP - ALPHA (INUM0: INUM- 1) 

CALL CONVERT (TEMP , 40 , 1 , T1 ) 

ACCEL (2) - T1 
IACCEL (2) - 1 
INUM - INUM + 1 

IF (INUM .GT. 60 .OR. ALPHA ( INUM- 1 : INUM- 1 ) . EQ . ' ') 

1 GOTO 440 

END IF 

IF (ALPHA (INUM: INUM) . EQ . ' ') THEN 

IACCEL (3) - 0 
ELSE 

TEMP (1:40) - ' ' 

TEMP - ALPHA (INUM: 60) 

CALL CONVERT (TEMP, 4 0 , 1 , T1 ) 

ACCEL (3) - T1 
IACCEL ( 3 ) - 1 

END IF 
END IF 
END IF 
READ (20, * ) 

READ (20,120) ATEMP 
FORMAT ( 2 8X, Al ) 

IF (ATEMP .EQ. ' ') THEN 

I TIME - 0 

ELSE IF (ATEMP .EQ. '+') THEN 
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ITIME - 
ELSE 

BACKSPACE 20 
PEAD ( 20 , 121) TIME 
121 FORMAT (2 8X, F20 . 8 ) 

ITIME * 1 

IF (TIME .LT. 0.0) THEN 

WRITE (6,-*) 'YOU HAVE ENTERED A NEGATIVE TIME : ' , T IME 

STOP 
END IF 
END IF 
DO I * 1,3 

POINT ( I ) * POINT (I) *P I / 1 80 . 0 

PATE (I) * RATE (I) *PI/180.0 

ACCEL (I) * ACCEL (I) *PI/ 100.0 

IF (I . LE. 2) THEN 

SLEW ( I ) * SLEW (I) # PI/180.0 

ROLL ( I ) - ROLL (I) *P I / 1 8 0 . 0 

END IF 

END DO 

TIME * TIME * 60.0 

RETURN 

END 
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SUBROUTINE ROLLER (TIME, PTIME, A, I POINT , POINT, ROLL, IROLL, I READ, WP , 
1 IS YS ) 

IMPLICIT REAL* 8 (A-H,0-Z) 

COMMON /COM3/ P I , TWOP I , P 102 
COMMON / COM4 / RBURN 

COMMON /C0M7/ SANG1 , SANG2 , STARR0T1 , STARR0T2 , SV1 ( 3 ) , $V2 ( 3 ) 
DIMENSION A ( 3, 3) , IPOINT (3) , POINT (3) , ROLL (2) , IROLL (2) , SV1M (3) , 

1 SV2M ( 3 ) 


1 

I 


1 

1 


1 


30 


IF ( ISYS . NE . 4) THEN 

CALL GETPROJ (TIME, A, ROT ) 

IF ( IPOINT ( 1 ) .EQ. 2) THEN 
ROLLANG1 - ROT + PE URN 
ELSE IF (IPOINT (3) . NE . 0) THEN 

ROLLANG1 - ROT + POINT (3) 

ELSE 

ROLLANG1 - 0.0 
END IF 
ELSE 

IF ( IPOINT ( I ) .EQ. 1) THEN 

SV1M (2 ) - A(2,l) * SVl(l) + A (2 , 2 ) * SV1(2) + A(2,3) 

* SV1 (3) 

SV1M ( 3 ) - A ( 3 , I ) * SV1(1) + A ( 3 , 2 ) * SV1(2) + A(3,3) 

* SVI ( 3 ) 

ROT - AT AN 2 ( SV1M ( 3 ) , SV1M ( 2 ) ) 

ROLLANG1 - ROT + POINT (1) 


ELSE 

SV2M (2) 


SV2 (2) + A (2 , 3 ) 
SV2 (2) + A ( 3 , 3 ) 


A (2 , 1 ) * SV2 (1) + A<2, 2) 

* S V2 ( 3 ) 

SV2M ( 3 ) - A ( 3 , 1 ) * SV2 ( 1 ) + A(3,2) 

* S V2 ( 3 ) 

ROT - ATAN2 ( SV2M ( 3 ) , SV2M ( 2 ) ) 

ROLLANG1 - ROT + POINT (2) 

END IF 
END IF 

ROLLANG - ANG (ROLLANGl ) 

WRITE (13,*) ' ROLLING TO CORRECT ATTITUDE, TIME, ROLLANG-' 

TIME, ROLLANG 
IF (ROLLANG . GT . PI) THEN 
ROLLANG - ROLLANG - TWOP I 
SROLL - -ROLL ( 1 ) 

S ACCEL - -ROLL (2) 

ELSE 

SROLL - ROLL ( 1 ) 

S ACCEL - ROLL (2) 

END IF 

IF ( IROLL ( 1 ) .EQ. 0 .AND. IROLL(2) .EQ. 0) THEN 
CALL ROTATE (A, 0 . 0 , 0 . 0 , ROLLANG, 0 , 0 , 1 ) 

ELSE IF ( IROLL ( 1 ) . EQ . 1 .AND. IROLL(2) . EQ . 0) THEN 
TTS - ROLLANG 7 SROLL 
IF (TIME + TTS .GT. PTIME) THEN 
ANGTRAV - SROLL * (PTIME-TIME) 

CALL ROTATE (A, 0 . 0 , 0 . 0 , ANGTRAV, 0 , 0 , 1 ) 

ROLLANG - ROLLANG - ANGTRAV 
WP - SROLL 
TIME - PTIME 

CALL OUTPUT ( IREAD , TIME , A, WP , WQ, WR, PTIME) 

GOTO 30 
ELSE 

TIME - TIME + TTS 
WP - 0 . 0 

CALL ROTATE ( A, 0 . 0 , 0 . 0 , ROLLANG, 0 , 0 , 1 ) 

END IF 

ELSE IF (IROLL (1) 

TEMP 1 - (0.5* 

TACC1 - ( -WP + 


.EQ. 1 .AND. IROLL (2 ) .EQ. 1) THEN 
WP * *2 + ROLLANG * SACCEL)**0.5 
TEMPI) / S ACCEL 
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TACC2 - (-WP - TEMPI ) / SACCEL 

IF (TACC1 -GT. TACC2) THEN 
TACC - TACC1 
ELSE 

TACC - TACC2 
END IF 

IF (TACC . LT. 0.0) THEN 
TACC * 0.0 
END IF 

WPMAX - WP ♦ TACC * SACCEL 
IF (ABS (WPMAX) .GT. ABS ( SROLL) ) THEN 
TACC - (SROLL-WP) /SACCEL 
WPMAX - SROLL 
END IF 

T 1 - TIME + TACC 

TDEC - TACC + WP/ SACCEL 

ANGT - WP * TACC + 0 . 5 * SACCEL * TACC**2 + 0.5 * SACCEL 
* TDEC ** 2 

T2 - T1 + (ROLLANG-ANGT) /SROLL 
TTS - T2 + TDEC - TIME 
TACCEL - ROLL (I) / ROLL (2) 

AN G ACC - 0 . 5 * ROLL (2) * TACCEL* * 2 

ANGDEC - ROLL (2) * TACCEL - ANGACC 

IF (ABS (ROLLANG) . LT . ANGACC + ANGDEC) THEN 

TTS - (4.0 * ABS (ROLLANG) / ROLL (2)) ** 0.5 

T1 - TIME + TTS * 0.5 
T2 - T1 
ELSE 

TTS - 2.0 * TACCEL + {ABS (ROLLANG) - ANGACC - ANGDEC) 
/ ROLL ( 1 ) 

T1 - TIME + TACCEL 
T2 - TIME + TTS - TACCEL 
END IF 

IF <T1 .GT. PTIME) THEN 

ANGTRAV - WP * (PTIME-TIME) + 0.5 * SACCEL * (PTIME - 
TIME) **2 

WP * WP + SACCEL * (PTIME-TIME) 

ROLLANG - ROLLANG - ANGTRAV 

CALL ROTATE (A, 0.0,0. 0 , ANGTRAV, 0,0,1) 

TTS - TTS - (PTIME-TIME) 

TIME - PTIME 

CALL OUTPUT ( IREAD , TIME, A, WP , WQ, WR f PTIME) 

GOTO 40 

ELSE IF (T2 .GT. PTIME) THEN 
IF (TIME .LT. Tl) THEN 

ANGTRAV - WP * (Tl -TIME) + 0.5 * SACCEL * (T1- 

TIME) **2 + WPMAX * (PTIME-T1) 

ELSE 

ANGTRAV - WPMAX * (PTIME-TIME) 

END IF 
WP - WPMAX 

ROLLANG - ROLLANG - ANGTRAV 
TTS - TTS - (PTIME-TIME) 

TIME - PTIME 

CALL ROTATE < A, 0 . 0 , 0 . 0 , ANGTRAV, 0,0,1) 

CALL OUTPUT ( IREAD , TIME, A, WP , WQ, WR, PTIME) 

GOTO 40 

ELSE IF (TIME + TTS . GT . PTIME) THEN 
IF (TIME .LT. Tl) THEN 

ANGTRAV - WP * (Tl -TIME) + 0.5 * SACCEL * (Tl- 

TIME) **2 + WPMAX * (PTIME-T2 ) + WPMAX * 
(T2-T1) - 0.5 * SACCEL * (PTIME-T2 ) * * 2 
WP - WPMAX - SACCEL * (PTIME-T2 ) 

ELSE IF (TIME . LT . T2) THEN 

ANGTRAV - WPMAX * (T2 -TIME) -0 . 5 * SACCEL * (PTIME - 

T2 ) * *2 + WPMAX * (PTIME-T2) 
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WP - WPMAX - SACCEL * (PTIME-T2) 

ELSE 

ANGTRAV - WP * (PTIME-TIME) - 0.5 * SACCEL * 
1 (PTIME-TIME ) **2 

WP * WP - SACCEL * (PTIME-TIME) 

END IF 

ROLLANG - ROLLANG - ANGTRAV 

CALL ROTATE ( A, 0 . 0 , 0 . 0 , ANGTF-AV, 0,0,1) 

TTS - TTS - (PTIME-TIME) 

TIME - PTIME 

CALL OUTPUT ( IFEAD, TIME , A, WP , WQ, WR, PTIME) 

GOTO 40 
ELSE 

TIME - TIME + TTS 

CALL ROTATE ( A, 0 . 0 , 0 . 0 , ROLLANG, 0 , 0 , 1 ) 

WP - 0 . 0 
END IF 
END IF 

WRITE (13, * ) 'FINISHED ROLLING, TIME-', TIME 

RETURN 

END 
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SUBROUTINE ROTATE (A, ANG1 r ANG2 , ANG3 , N1 , N2 , N3 ) 

IMPLICIT REAL* 0 (A-H,0-Z) 

DIMENSION A (3, 3) , B (3, 3) , N <3) , ANGLE (3) , SANG (3) , CANG { 3 ) 
ANGLE (1) - ANG1 

ANGLE ( 2 ) - ANG2 

ANGLE (3) - ANG3 
N ( 1) - N1 

N (2) * N2 
N (3) * N3 
DO I * 1,3 

SANG ( I ) - SIN (ANGLE (I) ) 

CANG (I) * COS (ANGLE (I) ) 

END DO 
DO I ■ 1,3 

IF (N ( I ) . EQ . 1) THEN 

B ( 1 , 1 ) - A { 1 , 1 ) 

B ( 1 , 2 ) - A ( 1 , 2 ) 

B ( 1 , 3 ) - A(l, 3) 

B ( 2 , 1 ) - A ( 2 , 1 ) * CANG ( I ) + A ( 3 , 1 ) * SANG ( I ) 

B(2,2) - A ( 2 , 2 ) * CANG (I) + A(3,2) * SANG(I) 

B ( 2 , 3 ) - A ( 2 , 3 ) * CANG ( I ) + A ( 3 , 3 ) * SANG ( I ) 

B(3,l) - -A (2,1) * SANG (I) + A (3,1) * CANG ( I ) 

B ( 3 , 2 ) - -A (2,2) * SANG (I) + A (3, 2) * CANG (I) 

B ( 3 , 3) - -A (2,3) * SANG ( I ) + A<3,3) * CANG (I) 

DO J - 1,3 

DO K - 1, 3 

A ( J, K) - B ( J, K) 

END DO 
END DO 

ELSE IF (N ( I ) .EQ. 2) THEN 

8(1,1) - A ( 1 , 1 ) * CANG (I) - A ( 3 , 1 ) * SANG(I) 

B ( 1 , 2 ) - A ( 1 , 2 ) * CANG { I ) - A(3,2) * SANG(I) 

B ( 1 , 3) - A ( 1 , 3 ) * CANG (I) - A<3,3) * SANG(I) 

B (2 , 1) - A (2 , 1) 

B (2 , 2 ) - A (2, 2) 

B (2 , 3) - A (2 , 3) 

B ( 3 , 1 ) - A ( 1 , 1 ) * SANG (I) + A (3, 1 ) * CANG(I) 

B ( 3 , 2 ) - A ( 1, 2) * SANG (I) ♦ A(3,2) * CANG(I) 

B ( 3 , 3 ) - A ( 1 , 3) * SANG ( I ) + A<3,3) * CANG(I) 

DO J - 1,3 
DO K - 1,3 

A { J, K) - B ( J, K) 

END DO 
END DO 

ELSE IF (N ( I ) .EQ. 3) THEN 

B ( 1 , 1 ) - A ( 1 , 1 ) * CANG ( I ) + A (2 , 1 ) * SANG(I) 

B ( 1 , 2) - A ( 1 , 2 ) * CANG ( I) + A(2,2) * SANG(I) 

B ( 1 , 3) - A (1 , 3) * CANG ( I ) + A<2,3) * SANG(I) 

B (2 , 1 ) - -A (1,1) * SANG ( I ) + A (2 , 1 ) * CANG(I) 

B (2 , 2 ) - -A (1,2) * SANG ( I ) ♦ A(2,2) * CANG(I) 

B (2 , 3 ) - -A (1,3) * SANG ( I ) + A(2,3) * CANG<I) 

B ( 3 , 1 ) - A (3 , 1) 

B ( 3 , 2 ) - A (3 , 2) 

B ( 3 , 3) - A ( 3 , 3 ) 

DO J - 1, 3 
DO K - 1,3 

A ( J, K) - B { J, K) 

END DO 
END DO * 

END IF 
END DO 
RETURN 
END 
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SUBROUTINE SLEWER (TIME, CI2M, ROLLTEMP , ANGTRAV, POINT, IPOINT , ROLL1 , 
1 PSI , THT, PHI , A) 

IMPLICIT REAL* 8 <A-H,0-Z) 

COMMON / C OM 4 / RBURN 

COMMON /COM6 / TRO , TR1 , TP.2 , WPMAX 

DIMENSION A (3, 3) , POINT (3) , IPOINT (3) , B <3, 3) , CI2M (3, 3) 

CALL ROTATE (CI2M , ANGTRAV, 0.0, 0.0, 3,0,0) 

DO I- 1,3 

DO J » 1,3 

A ( I , J) * CI2M ( I , J) 

END DO 
END DO 

IF (TR1 . EQ. TRO) THEN 

ROLLT * (TIME -TRO) * WPMAX 
ELSE 

IF (TIME . LT. TR1 ) THEN 

WPT - WPMAX / (TR1-TR0) * (TIME-TR0) 

ROLLT - 0.5 * (TIME-TR0) * WPT 
ELSE IF (TIME . LT . TP.2 > THEN 

ROLLT * 0.5 * (TR1-TR0) * WPMAX + WPMAX * (TIME-TRl) 

ELSE 

WPT * -WPMAX / (TR1-TR0) * ( TIME-TR2 ) + WPMAX 

ROLLT - (TR2-TR0) * WPMAX - 0.5 * (TR2+TR1- TRO -TIME) * WPT 

END IF 
END IF 

ROLLT - ROLL1 + ROLLT 

CALL ROTATE ( A, 0 . 0 , 0 . 0 , ROLLT , 0 , 0 , 1 ) 

PSI * ATAN2 (A(l, 2) ,A(1, 1) ) 

THT - ASIN ( -A ( 1 , 3) ) 

PHI - ATAN2 (A(2, 3) , A(3, 3) ) 

RETURN 

END 


A-41 



SUBROUTINE SUNV (TIME, RA, DEC) 
IMPLICIT REAL * 8 <A-H,0-Z) 

COMMON / COM2 /P INT , TIMED 
COMMON/ COM3 /P I , TWOP I, PI02 

DIMENSION XSUN { 3 ) 


DATA 

DJULO 

/24332S2 . 5/ 

DATA 

OBLO 

/ .40920621/ 

DATA 

SOBL0 

/ .39788120/ 

DATA 

COBLO 

/ . 91743695/ 

DATA 

OBLD 

/- . 6218E-8/ 

DATA 

PEQD 

/ . 6675E-6/ 

DATA 

GHAO 

/I .74664770/ 

DATA 

GHADI 

/. 0172027918/ 

DATA 

GHADF 

/6 . 3003881/ 

DATA 

AS UNO 

/6 . 2482947/ 

DATA 

ASUND 

/ . 01720197/ 

DATA 

ECCSO 

/ .016730108/ 

DATA 

ECCSD 

/- . 1148E-8/ 

DATA 

XLPSO 

/ 4 . 9232341/ 

DATA 

XLPSD 

/. 8217E-6/ 


DJUL - TIMEO + TIME/86400. , 

DAYS-DJUL -DJULO 
OBL-OBLO +OBLD*DAYS 
SOBL-SIN (OBL) 

COBL-COS (OBL) 

ECCSUN-ECCSO +ECCSD*DAYS 
XLPSUN-XLPSO +XLPSD*DAYS 
A — DMOD ( (AS UNO +ASUND* (D JUL-D JULO ) ) , TWOFI) 

E-A 

1 B-E-ECCSUN*SIN(E) -A 

IF (ABS (B) ,LT.l.E-5)GO TO 5 
DBDE-1 . -ECCSUN*COS (E) 

E-E-B/DBDE 
GO TO 1 

5 TN— SQRT { 1 . -ECCSUN* *2 ) *SIN (E) 

TD-COS (E) -ECCSUN 

F- AT AN 2 ( TN , TD ) 

ANG-XLPSUN+F 
SANG -SIN (ANG) 

GANG -COS (ANG) 

XSUN(l) - CANG 

XSUN (2) - SANG*COBL 

XSUN (3) - SANG*SOBL 

RA - AT AN 2 (XSUN ( 2 ) , XSUN (1 ) ) 

DEC - ATAN2 (XSUN ( 3) , (XSUN ( 1 ) * *2+XSUN ( 2 ) +* 2 ) **0 . 5) 

RETURN 

END 
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